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Enquadramento e objectives da disciplina 

A designagao robotica industrial surge do estudo dos manipuladores roboticos que sao usualmente 
conhecidos por robots industrials. A disciplina tern como principal objectivo o de dar formagao sobre os 
principios da manipulagao robotica e a sua fundamentagao matematica. Desse modo, nao se aborda uma 
linguagem particular para a programagao de robots industrials, mas espera-se que, no final, um aluno com 
aproveitamento e com conhecimentos rudimentares de programagao, consiga aprender e compreender uma 
qualquer linguagem para programar manipuladores. 

A disciplina enquadra-se no periodo final de uma licenciatura com afinidade a automagao, e 
pressupoe bons conhecimentos de algebra e das grandezas e conceitos de mecanica, bem como uma razoavel 
capacidade de lidar com objectos no espago a tres dimensoes. 

Antes de entrar no ponto central do programa, que sao a cinematica directa, inversa e diferencial, e 
dado um certo destaque a sistemas de coordenadas e transformagoes geometricas para permitir uma 
progressao mais solida pelo programa dentro. 

Em detrimento da estatica e dinamica de manipuladores, que se reconhece ser de importancia muito 
relevante, nomeadamente para o controlo, projecto e concepgao de bragos roboticos, optou-se por fazer uma 
introdugao a visao por computador pelo facto de tal area se apresentar como das mais importantes na 
robotica industrial actual. Igualmente consequencia desse cuidado e a relativamente pequena dimensao da 
atengao dada ao planeamento de trajectoria. Todavia, os fundamentos e metodos principals estao 
contemplados e assegurados. 

Na componente pratica os alunos trabalharao em MatLab que se revela uma ferramenta 
perfeitamente indlcada para estas materias onde a manipulagao de vectores e matrizes e, a modo de dizer, 
obrigatoria. 

Bibliografia 

Introduction to Robotics - P. McKerrow, Addison-Wesley, 1993. 

Robotics: Control, Sensing, Vision, and Intelligence - K. Fu, R. Gonzalez, C. Lee, McGraw-Hill, 1987. 
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Industrial Robotics Handbook - V. Hunt, Industrial Press Inc., 1983. 

Nota 

Este documento nao substitui a bibliografia. Trata-se de resumos, de caracter nao totalmente 
completo e, por vezes, de densidade variavel na abordagem dos diversos assuntos. 
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1. Introdugao 



1.1 Origem do termo 'robot' 

Em portugues ha o termo alternativo "robo". O termo eslavo Robota significa trabalhos forgados ou 
escravos, e teve a sua divulgagao numa pega de 1921 de Karel Capek. 

Numa evolugao do mito passando pelo sonho de Capek (entre outros) ate a ficgao dos tempos 
correntes, o conceito de robot ou servo do homem tem ocupado a mentalidade do ser humano. Um exemplo 
contemporaneo dessa realidade foi dado pelo grande contributo de Isaac Asimov, que chegou a definir as 
Leis da Robotica por volta de 1950- 

1^ Lei: Um robot nao pode maltratar um ser humano, ou pela sua passividade deixar 
que um ser humano seja maltratado. 

2- Lei: Um robot deve obedecer as ordens dadas por um ser humano, excepto se 

entrarem em conflito com a 1- lei. 

3- Lei: Um robot deve proteger a sua propria existencia desde que essa protecgao nao 

entre em conflito com a 1- ou 2- lei. 

1.2 Algumas definigoes de Robot e Robotica 

Texto da FAQ comp. robotics 

"Dispositivos electromecinicos pre-programaveis para execugao de uma variedade de 
fungoes. " 

Dicionario Webster- 

"Dispositivo automatico que executa fungoes normalmente atribufdas a humanos ou uma 
maquina com a forma de um humano. " 

ESHED Robotics, 1984 

"Um robot e um brago mecanico; um manipulador concebido para levar a cabo muitas 
tarefas diferentes, e capaz de ser programado sucessivamente. Para levar a cabo as 
tarefas atribufdas, o robot move componentes, objectos, ferramentas e outros 
dispositivos especiais por meio de movimentos e pontes pre-programados. " 

Em 1986, P. McKerrow propos para robot a seguinte definigao- 

"Um robot e uma maquina que pode ser programada para fazer uma variedade de 
tarefas, do mesmo modo que um computador e um circuito electronico que pode ser 
programado para fazer uma variedade de tarefas. " 

McKerrow 

"Robotica e a disciplina que envolve: a) o projecto, construgao, controlo e programagao 
de robots; b) o uso de robots para resolver problemas; c) o estudo dos processes de 
controlo, sensores e algoritmos usados em tiumanos, animals e maquinas, e; d) a 
aplicagao destes processes de controlo e destes algoritmos para o projecto de robots. " 

The Robot Institute of America 

"Um robot e manipulador multi-funcional, programavel, projectado para mover materials, 
componentes, ferramentas ou dispositivos especiais atraves de movimentos 
programaveis variaveis para a execugao de uma variedade de tarefas. " 

Standard International ISO 8373:1994(E/F) : 

"Manipulating industrial robot: Automatically controlled, reprogrammable multipurpose 
manipulator programmable in three or more axes, which may be either fixed to place or 
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mobile, of use in industrial automation applications. The robot includes - the manipulator 
- the control system (hardware and software)" 

Usualmente o termo Robotica emprega-se para indicar a disciplina associada ao uso e programagao 
de robots, e a expressao Engenharia Robotica e mais especifico e refere-se a construgao de robots e 
dispositivos roboticos. 

Nem todos os sistemas automaticos sao robots; os sistemas automaticos de fungoes fixas, como alguns 
brinquedos com mobilidade ou mesmo uma maquina de Comando Numerico nao sao consideradas robots. 
Para ter esse estatuto, devera o dispositivo ter uma capacidade de programagao e, mais ainda, de alguma 
adaptagao ao problema pratico. Claramente, um robot pressupoe um sistema que interage fisicamente pelo 
movimento de certas componentes mecanicas. 

1.3 Classificagao de robots 

1.3.1 Geragoes (cronologicamente) 

1^-Robots executores (pJaybacJd - repetem uma sequencia de instrugoes pre-gravada como a 

pintura ou soldadura. 
2^-Robots controlados por sensores - possuem malhas fechadas de realimentagao sensorial. 

Tomam decisoes com base nos sensores. 
3^-Robots controlados por visao - a malha fechada de controlo inclui um sistema de visao 

(imagem que e processada) 
4^"Robots com controlo adaptativo ■ o robot pode reprogramar as suas acgoes com base nos seus 

sensores. 
5^-Robots com inteligencia artificial ■ usa tecnicas de inteligencia artificial para tomar as suas 

decisoes e ate resolver problemas. 

1.3.2 Nivel de inteligencia do controlador (pela JIRSA) 

Dispositivos manuais - operados por pessoas 

Robots de sequencias fixas 

Robots de sequencias variaveis - onde o operador pode mudar a sequencia com facilidade. 

Robots executores {playback - onde o operador humano guia o robot a executar uma tarefa 

fixa. 
Robots controlados numericamente - o operador fornece apenas o programa do movimento, em 

vez de o ensinar manualmente 
Robots inteligentes ■ percebem e interagem com alteragoes no ambiente. 

1.3.3 Nivel de controlo dos programas no controlador 

Inteligencia artificial - instrugoes de alto nivel que serao decompostas pelo sistema em fungoes 
de mais baixo nivel. 

Modo de controlo ■ os movimentos do sistema sao modelizados incluindo as interacgoes 
dinamicas entre os diferentes mecanismos. As trajectorias sao planeadas a partida, 
bem como os pontos de contacto com os elementos a trabalhar (manipular). Deste 
modelo e formulada uma estrategia e os comandos de controlo sao enviados para 
proximo nivel mais baixo. 

Servo-sistema ■ os actuadores controlam os parametros do dispositivo usando os dados 
sensoriais nas malhas de controlo. 

1.3.4 Linguagem de programagao 

Sistema guiados - O operador indica os movimentos que o robot deve fazer 

Programagao ao nivel do robot ■ O utilizador escreve um programa a especificar as sequencias 

de movimentos que o robot tera de executar. 
Programagao ao nivel de tarefa ■ o programador especifica apenas as acgoes a tomar sobre os 

objectos que o robot manipulara. 

1.4 Alguns marcos na historia da robotica 

1801 - J. Jacquard inventou um tear programavel 

1959 - Primeiro robot comercial introduzido pela Planet Corporation. Era controlado por fins- 
de-curso e excentricos 
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1960 - Primeiro robot "Unimate". Principios de controlo numerico e actuadores hidraulicos. 

No ano seguinte foi instalado na Ford. 
1968 - Um robot movel desenvolvido no Stanford Research Institute- "Shakey". Camara de 

video e sensores de contacto. 
1971 - O brago de Stanford desenvolvido pela Universidade de Stanford com actuagao 

electrica. 
1973 - Primeira linguagem de programagao de robots' WAVE seguida em 1974 pela 

linguagem AL. As duas deram lugar mais tarde ao aparecimento da VAL, linguagem 

comercial da Unimation 

1978 - PUMA introduzido pela Unimation 

1979 - SCARA desenvolvido na Univerisdade de Yamanashi com introdugao comercial em 

1981. 
1981 - Robot com actuagao directa ("direct drive") desenvolvido na CMU 
1983 - Projecto para uma linha flexivel de montagem automatizada com o uso de robots. 
1997 - A Honda anuncia o primeiro robot humanoide que sobe escadas. 

1.5 Os manipuladores roboticos 

1.5.1 Robotica fixa versus robotica movel 

As tres categorias principals de robots sao 

-Os manipuladores - robots industrials 
-Os veiculos auto-guiados (AGV) 
-Os robots moveis 

As principals diferengas entre estas categorias incidem nos seguintes pontos- 
-Conhecimento continuo daposigdo (verdade nos bragos), 
-Aplicagoes distintas (manipulagdo e transporte), 
-Necessldade de percepgdo do ambiente (crucial nos moveis), 
-tipo de programagao usada (normalmente mais exigente nos robot moveis). 

1.5.2 Elementos principals de um manipulador (ou robot industrial) 
1.5.2.1 Brago e punho (arm-wrist) 

O brago e a parte do manipulador que esta normalmente associada ao posicionamento (x, y, z) no 
espago fisico cartesiano, ou operacional. O punho afecta essencialmente a orientagao (0,(|),\|/) da garra, pinga 
ou outros end- effector. 

Todavia, e muito comum que haja efeitos cruzados - o brago afectar tambem a orientagao e o punho 
afectar a posigao cartesiana Estes componentes de um manipulador sao constituidos por partes rigidas, os 
elos {links), ligadas entre si pelas juntas {joints) 



Junta 




Figura 1.1 - Elos e junta de um manipulador 



1.5.2.2 O controlador 



Unidade capaz de gerar informagao de activagao de um ou mais actuadores com base num algoritmo 
de controlo. Esse algoritmo pode levar em linha de conta o comando desejado, o estado corrente do actuador, 
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e o proprio ambiente. Os algoritmos mais comuns recorrem ao chamado controlo PID (proporcional-integral- 
diferencial). 

Quando nao existente em separado, o controlador chega a incluir a unidade de potencia, ou seja, o 
elemento que liga directamente ao actuador fornecendo-lhe a energia que necessita com base numa 
informagao de baixo teor energetico, como sao os sinais electricos a saida de muitos controladores. 

Por vezes, o controlador faz parte de um sistema maior de interligagao com o utilizador exterior, como 
e o caso de um computador pessoal. Nestes casos o controlador pode assumir a forma de uma carta de 
expansao do proprio computador, ou ser um dispositivo exterior que comunica com o computador de uma 
forma padrao, como por exemplo, uma ligagao serie RS232. 

Esta integragao num computador, devido ao abundante numero de ferramentas de interface 
disponiveis, permite mais facilmente especificar os comandos desejados para o controlador, ou ate de os 
gerar de forma automatica, como fazem muitos programas (software). 

1.5.2.3 Actuadores 

Dispositivos que geram e impoem movimento a uma qualquer parte mecanica pelo desenvolvimento 
de forgas e binarios baseada num principio fisico de conversao de energia. Podem ser, por exemplo, motores 
electricos, cilindros hidraulicos, ou pneumaticos, electro-imanes, etc. Tem muitas vezes associados elementos 
adicionais de transmissao mecanica. Fazem a actuagao 

1.5.2.4 Sensores 



Elementos destinados a medigao do estado interno do manipulador bem como a percepgao do 
ambiente exterior. Principals tipos de sensores usados num manipulador- codificadores, fins-de-curso, 
sensores de forga, detectores de proximidade capacitivos e indutivos, etc. Fazem a percepgao. 



Comando 
desejado 



Controlador 

(decide que medida de 

actuagao deve ser 

imposta) 



Fonte de 
energia para 
OS actuadores , 



Unidade de potencia 

(fornece energia ao 

actuador com base nas 

ordens do controlador) 




Actuador 
(gera deslocamento 
inear ou rotacional) 




Figura 1.2 - Um sistema de controlo tradicional 



1.6 O robot e a automagao 

1.6.1 Tipos de automaQao 

A automagao pode ser de dois tipos fundamentals' rigida e flexivel (programada) 
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CONVEYOR A 



ARM C 



ARM B 



ARK A 




Figura 1.3 - Automagao rigida 




Figura 1.4 - Automagao flexivel 



Rigida - cada componente do sistema tern 
sempre a mesma fungao ou conjunto limitado de 
fungoes sem possibilidade de alteragao de modo 
simples, obrigando a existencia de varios 
componentes por vezes afins 



Flexivel" a multiplicidade de componentes 
da automagao rigida e reduzida pelo introdugao de 
um sistema mais versatil- caso dos manipuladores 



1.6.2 Aplicagoes tradicionais dos manipuladores industriais 

As aplicagoes tradicionais mais importantes sao as seguintes- manipulagao de materials, soldadura 
{spot welding), pintura a spray. Ha muitos construtores de robots manipuladores no mundo actual- alguns 
exemplos mais importantes de construtores e marcas sao- ABB, KUKA , STAUBLI, ADEPT, PUMA, ... 
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Figura 1.5 - Algumas aplicagoes industriais de manipuladores 

1.7 Importancia do robot industrial 

O robot industrial ve a sua importancia surgir a varios niveis- 

• Tecnica- Vantagem e versatilidade 

• Humana- Tarefas pesadas ou desagradaveis para humanos 

• Economica- Um mesmo equipamento pode ter multiplas fungoes e substituir varios equipamentos 
distintos. 
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A atestar a importancia do robot industrial vem os numeros expressos nos graficos das figuras 
seguintes que mostram como o parque robotico mundial tern evoluido muito nos ultimos 10 anos na 
industria (Fonte: Revista Robotica 1999) 
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Figura 1.6 - Numero de robots vendidos por ano e numero estimado de robots industriais em servigo. 
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Figura 1.7 - Numero de robots por 10 000 trabalhadores na industria 
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2. Estrutura e Tipologia de Manipuladores 



2.1 Componentes 

2.1.1 Brago mecanico 

O brago mecanico e constituido por juntas e elos (Joints and links). Os elos sao usualmente blocos 
alongados rigidos, e sao ligados uns aos outros atraves das juntas. Os elos podem variar a sua posigao 
relativa e estao normalmente associados em serie. Existem variadissimas combinagoes de elos e juntas de 
acordo com as aplicagoes, e que mais adiante se descreverao os tipos mais comuns. 

2.1.2 VontSiOMGsiYVdi {End-effector) 

Componente ligado a extremidade do brago, isto e, ligado ao ultimo elo do manipulador, e que tem 
fungoes adicionais (agarrar ou prender um objecto, ou ainda um dispositivo com fungoes adicionais mais 
especificas). A ponta ou end-effectoripode ser do tipo garra igripper) ou uma ferramenta {tool). 

2.1.2.1 Garras 

As garras de preensao mecanica (pinga) sao bastante comuns e eis de seguida alguns exemplos^ 
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Figura 2.1 - Alguns principios e tipologias de garras 
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De notar o tipo de forgas/movimentos aplicados e os resultados nas diversas situagoes. Saliente-se a 
garra do topo direito que pode servir para agarrar objectos de dimensao variavel gragas a sua mola. Ou 
ainda, a garra na ultima ilustragao, na regiao inferior direita, cujos dedos (pingas) de deslocam de forma 
perfeitamente linear. 

Alem das garras do tipo pinga ha ainda aquelas de funcionamento baseado em^ 

• Vacuo 

• Magnetica 

• Adesivos 

• Ou outros tipos dos quais se destacam as maos antropomorficas 



^-^ 




Figura 2.2 - Mao (garra) antropomorfica 



2.1.2.2 Ferramentas 



Nas ferramentas a variedade e muito grande mas as principals incluem as seguintes- 

• Soldadura 

• Corte jacto de agua 

• Furador, polidor, etc. 

2.1.3 Actuadores 

Os componentes que utilizam uma fonte de energia para fazer mover as juntas; sao de tres tipos 
essenciais. Els uma breve comparagao dos tres tipos de actuadores- 



Caracteristica 


Tipos de actuadores | 


Electricos 


Hidraulicos 


Pneumaticos 


Controlo 


Facil. Possibilidade de 
ser elaborado. 


Hoje em dia mais 

facilitado com as electro 

servo-valvulas 


Muito dificil devido a questoes de 
compressibilidade do ar 


Velocidades 


Grande 


Media/Grande 


Muito grande 


Binario a baixa velocidade 
(aceleragoes) 


Pequenos/Medios 


Grande 


Pequenos 


Precisao 


Boa. Limitada pelo uso 
de transmissao 


Boa 


Ma, excepto em operagoes a 
posigoes fixas. 


Funcionamento em situagao 
estatica 


Mau. Requer travoes. 


Excelente. Trata-se de 
funcionamento normal. 


Bom. Nao ha risco de danificagao 
do sistema. 


Questoes ambientais 


A presenga de arcos 

electricos pode ser 

indesejavel. 


Perigo de fugas de oleo. 


Sistemas limpos. Risco de poluigao 

sonora de componentes, 

compressores e das fugas. 


Gustos 


Relativamente baixos 


Altos 


Relativamente baixos 



Tabela 2-1 - Breve comparagao dos principals tipos de actuadores 
Em cada junta ha normalmente um actuador. Ao contrario, no corpo humano, ha normalmente 2 
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musculos por cada junta para a moverem em direcgoes opostas. 
2.1.3.1 Tipo de actuagao 

Directa - O elemento movel do actuador e acoplado a junta directamente. 

Indirecta - o elemento movel do actuador e acoplado a junta mediante um sistema de transmissao. 



Actuagao indirecta 




Actuagao indirecta 



Figura 2.3 - Ilustragao da actuagao directa e indirecta 

Os motores electricos sao normalmente usados em actuagao indirecta (indirect drive) devido a 
combinagao alta velocidade/binario baixo. Sao excepgoes os casos dos motores especiais como os motores 
passo a passo, ou os chamados direct-drive motors, que tem uma concepgao especial e permitem altos 
binarios a baixas rotagoes. Porem, alguns destes tipos sao por enquanto motores de grandes dimensoes e 
peso, portanto limitados a poucas aplicagoes nos manipuladores; e possivel encontra-los na base, ou seja, a 
actuar a primeira junta do manipulador. 

2.1.4 Sensores 

Fornecem informagao ao controlador, nomeadamente em que local estao as diversas juntas do 
manipulador Alem destes sensores internos ha tambem os interruptores de fim de curso que delimitam as 
deslocagoes extremas das juntas. Existem tambem os sensores externos dedicados a recolher informagao 
adicional sobre o ambiente. 

2.1.4.1 Sensores de posigao 

Potenciometros , Vq ( t ) = KO ( t ) 



Ri^iyiiiLtL 




bt^;-Hiilii'^ 
^'kl!nL■h1 



* J\.r 



Figura 2.4 - Um potenciometro como indicador de posigao angular 
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Codificadores (incrementais e absolutes) 

Os codificadores (especialmente os opticos) apresentam a vantagem de nao possuir contactos sujeitos 
a desgaste como o poderia ser o cursor de um potenciometro. 

Disk 




Light 
source 



Grid 
assembly 



Plioto 
detector 



Squaring 
circuitry 




Figura 2.5-0 disco de um codificador optico relative e sistema de descodificagao relativa (direita) 

Photodetector Stationary mask LED light source 




Position 



^^M^"-^ 



Rotating 
encoder dlsl< 

Figura 2.6-0 disco de um codificador optico absolute e sistema de descodificagao obsoluta (direita) 

2.1.4.2 Sensores de velocidade 

Dispositivos que indicam a velocidade angular- Tacometros- Vq (t) = K^uo(t) = Kfi{t) 

2.1.5 Controlador 

O controlador e o componente que determina e, frequentemente, monitoriza o movimento de cada 
junta. Geralmente o controlador faz outras operagoes relacionadas com a aplicagao. A operagao fundamental 
e a fungao de controlo em cada junta, isto e, o processo pelo qual se procura que os elos/juntas fiquem 
posicionados ou tenham o movimento desejado numa dada tarefa a cumprir. Esse processo tem de obviar os 
problemas de que as acgoes de um certo actuador nao tem os efeitos desejados, ou seja, tera de haver um 
controlo em malha fechada ou chamado controlo realimentado. Note-se porem que ha sistemas (mormente 
didacticos) onde o controlo e feito em malha aberta. Quer isso dizer que os actuadores sao activados e que se 
espera que cumpram exactamente o previsto. Isso e possivel em certa medida com motores passo-a-passo. 

Se designarmos por m(t) a entrada de um controlador, e a diferenga entre a saida desejada para o 
sistema (actuador) e a sua real saida chamarmos erro e(t), as fungoes de controlo mais comuns sao as 
seguintes- 



on-off- m{t) — 



e(t) < 
proporcional- m{t) — Kpe(t) 



proporcional + diferencial (PD)' m{t) — Kpe(t) + K^ 
proporcional + diferencial +integral (PID)' 



de(t) 
dt 



Relembra-se que o valor ni(t) designa a entrada a aplicar no controlador em cada instante. 
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2.2 Tipos de juntas 

As juntas sao essencialmente de dois grandes tipos^ 

• As prismaticas (P) onde o movimento relative dos elos e linear 

• As rotacionais (R) onde o movimento relative dos elos e rotacional. 

• Existe ainda um terceiro tipo de junta designada por esferica (S) que no fundo e a combinagao de 
tres juntas rotacionais com o mesmo ponto de rotagao. 






Rotacional (revolute) 



Prismatica (linear) 



Esferica (3 rotacionais) (spherical 
or ball-and-socket) 



Figura 2.7 - Tipos de juntas 

Na maioria dos manipuladores, as juntas sao normalmente divididas em dois grupos- 

• Juntas principals (3 juntas mais proximas da base) 

• Juntas secundarias ou juntas do punho (as restantes juntas, mais proximas do end-effector) 

2.2.1 Graus de liberdade e graus de mobilidade 

Graus de liberdade (degrees -of freedom - DOF) e o numero total de movimentos independentes que 
um dispositive pode efectuar. Um cube no espago a 3 dimensoes pode deslocar-se ao longo dos tres eixos, e 
tambem rodar em torno de cada um deles, dando assim um total de 6 graus de liberdade para a sua 
movimentagao. 

Algo diferente sao os graus de mobilidade, associados ao numero de juntas existentes. Um exemplo 
comum desta diferenga sao os tripes' na verdade em cada pe temos varias juntas prismaticas que afectam o 
mesmo o mesmo movimento, isto e ao longo daquele eixo em particular. Se em cada pe houver 3 juntas, 
teremos um tripe com 3 graus de liberdade mas 9 graus de mobilidade. 

Exemplos de graus de liberdade necessaries para certas tarefas- 




Para mudar esta pega e roda-la 
sao necessaries 4 graus de liberdade 
apenas. (nota- o manipulador 
ilustrado podera nao ter a 
possibilidade de o fazer, para certas 
orientagoes) 
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Para colocar esta pega no 
encaixe (que pode ter uma orientagao 
arbitraria) sao necessario 6 graus de 
liberdade- 3 para as posigoes xyz e 3 
para as 3 orientagoes do encaixe. (o 
manipulador ilustrado nao o permite) 



Figura 2.8 - Graus de liberdade necessaries para dois exemplos de movimento 

2.2.2 Representagao e arranjo cinematico 

Frequentemente, em diversa literatura existe uma simbologia propria para representar de uma forma 
padrao um manipulador e as suas juntas. De seguida ilustra-se um caso para um manipulador RRP e mais 
uma junta esf erica. 




Figura 2.9 - RepresentaQao de um manipulador com as juntas RRPS, num total de 6 DOF 

2.2.3 O brago humano 

Cada brago humano, excluindo a mao e os dedos, dispoe de 7 graus de liberdade- 




Junta 


Tipo 


Graus de 

liberdade 

(DOF) 


Ombro {Shoulder) 


Esferica 


3 


Cotovelo {Elbow) 


Rotacional 


1 


Pulso {Wrisi) 


Esferica 


3 



Figura 2.10 - Graus de liberdade do brago humano 

2.3 Espago de trabalho e tipos de manipuladores 

Espago ou volume de trabalho ( workspace or volume space) de um manipulador e a regiao dentro da 
qual o manipulador pode posicionar o end-effector. 

Quando se classifica um robot pela sua estrutura cinematica, isto e, pelo seu espago de trabalho, 
apenas as juntas principals sao usadas. Assim, ha essencialmente 5 categorias de estruturas cinematicas 
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que se ilustram e descrevem resumidamente de seguida- 
Cartesiana (PPP) 
Cilindrica (RPP) 
Esferica (RRP) 

Articulado horizontal ou SCARA (RRP) 
Articulado vertical ou antropomorfico (RRR) 

2.3.1 Cartesiano (PPP) 




Figura 2.11 - Manipulador cartesiano (PPP) 



2.3.2 Cilindrico (RPP) 




Figura 2.12 - Manipulador Cilindrico (ou RPP) 
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2.3.3 Esferico (RRP) 




Figura 2.13 - Manipulador Esferico (RRP) 



2.3.4 Articulado Horizontal - SCARA (RRP) 






L2> Li 



L2 < Li 



Volume do espago de trabalho: V = 



ttA 






Figura 2.14 - Manipulador Articulado Horizontal-SCARA (RRP) 
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2.3.5 Articulado vertical (antropomorfico) - RRR 







L2> Lj 



Volume do espago de trabalho- V = 



3" 



L1-L2 




L2< Lj 



ih+hf-{h-hf]^h>L: 



^^{l, + lJ 



^k<h 



Figura 2.15 - Manipulador Articulado vertical (ou antropomorfico) (RRR) 



Podemos comparar os volumes de trabalho admitindo que as juntas rotacionais varrem 360° e que as 
prismaticas sao todas iguais de comprimento L e que se deslocam o comprimento A e que A=L. Resulta 
assim a seguinte tabela 



Cartesiano 


V = L' 


Cilindrico 


V = 3frL^ 


Esferico 


3 


Articulado Horizontal 


V = AtiL^ 


Articulado Vertical 


3 



Note-se que o volume do espago de trabalho aumenta com o numero de juntas rotacionais. 

2.4 Resolugao, Repetibilidade, Precisao 

Resolugao- o menor movimento incremental de uma junta; normalmente detectavel pelo dispositivo 
de medigao (codificador). Exemplo, se o codificador tiver 180 incrementos entao a sua resolugao sera de 180 
incrementos por volta ou seja 3607180 = 2°. Esta e a resolugao angular, que pode ser convertida em 
resolugao espacial em fungao do comprimento da junta ( =L "^ sin (ResolAngular)) 

Repetibilidade- traduz a diferenga de posigao (linear em geral) com que o robot volta a recolocar-se 
num ponto visitado anteriormente. 

Precisao- traduz a diferenga entre uma posigao realmente atingida e a posigao desejada pela 
programagao. Esta relacionada com a resolugao e por certo nao podera ser melhor que o valor daquela (ou +/- 
metade) - afectado pela carga transportada e variavel conforme a zona do espago de trabalho. 
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Boa precisao 
Boa repetibilidade 




Boa precisao 
Ma repetibilidade 




Ma precisao 
Boa repetibilidade 




Ma precisao 
Ma repetibilidade 



Figura 2.16 - Ilustragao da precisao e repetibilidade 
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Sistemas de Coordenadas 




Yaw 




Roll 



RPY{(l),0,y/) = 



C(jCe -S(l)Cy/ + C(l)SeSy/ 

S(/)Ce C(t)Cy/ + S(/)S^y/ 

-SO cesxi/ 





S(l)Sy/ + C(l)S6Cy/ O' 

-C(/)Sy/ + S(/^eCy/ 

COCy/ 

1 
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3. Sistemas de Coordenadas 



3.1 Nogoes introdutorias - revisoes 



3.1.1 Sistemas de eixos 



Os sistemas de eixos coordenados a usar sao ortogonais e directos. Directos significa que o sentido 
positive dos angulos e medido pela convengao usual (sentido anti-horario) e que e ilustrado na Figura 3-17. 



y 





y 



X 

Figura 3-17 - Sistemas directos de coordenadas a duas e tres dimensoes. 

3.1.2 Vectores e Matrizes 

Um ponto no espago e representavel por um vector com 3 coordenadas (2 se for no piano), em 
particular um vector coluna, como se descrevera adiante. O termo vector e frequentemente associado a um 
conceito de movimento ou deslocagao numa dada direcgao (e sentido). Quando se referem as coordenadas de 
um vector, neste ultimo significado, esta-se a pensar num vector aplicado na origem do sistema de eixos e 
com as coordenadas do seu ponto extreme. Assim, no exemplo ilustrado de seguida, o vector r tem as 
mesmas coordenadas do ponto P; se bem que estejam em causa dois conceitos formalmente distintos, eles 
estao relacionados de tal forma que podemos usar o conceito de vector com representagao matricial, para 



representar qualquer das entidades geometricas (ponto e vector) sem perigo de confusao- r = 






ou 



p = 



Xq 



y 



P(xo,yo) 




y 




Piixuyi) 



X X 

Figura 3-18 - Um ponto e um vector no piano. Ilustragao da soma de um ponto com um vector 
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Por outro lado, define- se tambem a soma de um ponto com um vector, que resulta num segundo ponto 
iP^ = P + V ). Geometricamente, isso equivale a que o vector a somar tenha a sua origem situada no ponto 

inicial (P) e nao na origem do sistema de eixos. Porem, e pelo exposto acima, dizer que o resultado da soma e 

um novo ponto, e dizer tambem que e um segundo vector. Desse modo, a soma de um ponto com um vector (e 

forgosamente nesta ordem porque a soma de um vector com um ponto nao e definida!) equivale tambem a 

soma de dois vectores. No lado direito da Figura 3-18 podemos verificar que o vector v , para efeitos de soma 

(traduzindo a tal deslocagao ou movimento), e aplicado no ponto F, se bem que a sua representagao livre 

(como e muitas vezes dito) esta representada a tracejado e aplicada na origem do sistema de coordenadas. 

Estas duas representagoes sao todavia a mesma identidade traduzida numa propriedade comum (a 

equipolencia); nao obstante essa propriedade, sao dois segmentos de recta orientados distintos (estao em 

posigoes diferentes do piano). Este conceito de segmento de recta orientado nao e neste contexto 

interessante, e por isso restringir-nos-emos ao conceito de vector e da propriedade de equipolencia que ele 

traduz. 

Podemos entao extrair da Figura 3-18 que P^ = P + v ou ainda v = P^ — P , e dessa forma 

deter minar as coordenadas do vector v a custa dos dois pontos. O ponto Pi tem como coordenadas (xi,yi) 
que sao na verdade as coordenadas do vector associado u . Como se espera, u = r + v . 

No que diz respeito a nomenclatura, as designagoes de vectores sao indicadas por uma letra 
minuscula com uma seta por cima, em caracteres romanos (nao italicos) e por vezes ainda por essa mesma 
letra em tom carregado {bold). Essas duas representagoes (seta e bold) foram usadas acima mas, por 
facilidade de escrita, em geral, usa-se so uma delas, e de preferencia a versao a carregado, exceptuando-se os 
casos do texto manuscrito onde a versao com seta e preferivel. Por outro lado, para representar matrizes 
(arranjos rectangulares de numeros ou expressoes distintos entre si), dos quais os vectores sao casos 
particulares, usam-se letras romanas maiusculas em tom carregado (a seta ja nao faria muito sentido visto 
se perder a imagem geometrica da tal propriedade do sentido do movimento). Em suma, e para facilitar a 
escrita ao longo deste texto, usaremos as representagoes indicadas na tabela seguinte^ 



Entidade 



Vectores 



Matrizes 



Coordenada 



Ponto* 



Angulo 



Notagao das representagoes 



Letra romana minuscula a 
carregado sem (ou 
eventualmente com) seta por 
cima 



Letra romana maiuscula sem 
seta por cima 



Letra minuscula em italico 
(eventualmente romana) 



Letra maiuscula (romana ou 
italic a) 



Letra grega minuscula 



Exemplos 



V = V = 



T = 



a h 
c d 



Xq = 5 , ?/2 = 12 



Pi — ^i -^ l^0'%'^0 



TT 

"=3 



*Quando, em vez de ponto, pensarmos numa postura no espago (posigao e orientagao), o conceito de ponto 
desvanece-se e falaremos de um vector que se representara com letras minusculas como convencionado. 

As matrizes podem ser quadradas ou nao quadradas. As quadradas tem as duas dimensoes iguais, 
isto e, igual numero de linhas e de colunas. Ha um tipo particular de matrizes nao quadradas designadas 
por vectores que tem uma so linha ou uma so coluna. 
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T = 


a b 
c d 
1 




T = 


1 3 2 12 -1 
5 2 7 10 
-4283 




V = 


x 

y 

z 

1 




u = [l 4 -2 l] 


Matriz quadrada 
de ordem 3 (3X3) 


Matriz nao quadrada de 
dimensao 3X5 


Vector 
coluna 


Vector linha 



Das operagoes com matrizes ha a destacar as que se descrevem a seguir. 
3.1.2.1 Produto de um escalar por uma matriz 

E um operagao que resulta numa matriz cujos elementos sao todos afectados pelo mesmo factor 
multiplicativo- 







a V 




Xa Xb 


AT = 


= A 


c d 


— 


Xc Xd 



3.1.2.2 Inversao de uma matriz 

A inversao de uma matriz (quadrada) e a operagao pela qual se determina a sua inversa. A inversa de 
uma matriz A e uma outra matriz, representada por A'^, tal que o produto das duas resulta na matriz 
identidade- 

A A^ = I 

So as matrizes quadradas nao singulares tem inversa. A matriz inversa pode ser obtida, em geral, 
pela matriz adjunta de A dividida pelo deter minante de A- 

Adj{A) 



A-' = 



detA 



A matriz adjunta de uma matriz e obtida pela substituigao de cada termo pelo seu co-factor e 
transpondo a matriz de co-factores. 

3.1.2.3 Produto interno (escalar) de vectores 

O produto interno e uma operagao que resulta num escalar cujo valor e dado por^ 

V • U = V^Ux + VyUy — II VII. null COS a 



onde V = 



\^x] 




[^xj 


Vy 


, u = 


Uy 



V9 9 

'^x ~^ '^y e a e o angulo definido pelos dois vectores. 



Esta operagao e comutativa. Nao faz sentido falar de associatividade porque o produto interno so esta 
definido entre dois vectores, nao entre um vector e um escalar (aquele que resultaria do primeiro produto 
interno). 

3.1.2.4 Produto externo de vectores ou produto vectorial 

O produto externo de vectores e uma operagao que resulta num terceiro vector perpendicular aos dois 
primeiros. Ha varios simbolos para representar esta operagao e de seguida indicam-se alguns mais comuns. 
A operagao traduz-se deste modo- axb = a0b = aAb = c 
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-c 



Figura 3-19 - Produto vectorial e a sua anti-comutatividade. 

O vector resultante tern um sentido que advem do sistema directo usado, e que se representa na 
Figura 3-19, do lado esquerdo. Uma regra pratica para determinar o sentido do vector resultante consiste na 
chamada "regra da mao direita"; os dedos da mao estao fechados a excepgao do polegar que indica o sentido 
do vector resultante e os restantes dedos indicam o sentido do angulo entre os vectores. Ve-se claramente 
que o produto externo de vectores nao e comutativo, e alias e anti-comutativo, como se observa da Figura 
3-19. Quer isto dizer que- 

bxa=— axb=— c 

A definigao de produto vectorial leva-nos a seguinte expressao- 



a X b = det 









i 


J 


k 


«x 


ay 


a^ 


bx 


by 


h 



= [ayh^ - bya,)i - (a^b, - b^a,)} + [a^by - ^^^a^ )k 



onde ( i, j, k ) e a base ortonormada do sistema de coordenadas (versores unitarios) e a = 



b = 



Ainda sobre o produto vectorial pode-se dizer o seguinte- 

llcll = ||a X b|| = llall.||b||.|sina| 

3.1.2.5 Produto generico de matrizes 

Duas matrizes so sao multiplicaveis se tiverem a correcta concordancia de dimensoes. Cada novo 
elemento da uma matriz produto resulta do produto (interno) de cada vector linha do primeiro operando 
matricial com cada vector coluna da segunda matriz operando. Deste modo se verifica que o numero de 
colunas da primeira matriz deve ser igual ao numero de linhas da segunda matriz; no que respeita as 

dimensoes das matrizes envolvidas pode dizer-se, simbolicamente, o seguinte- 

(mxn)-(nxp) = (m x p) . 



I I I 
I I I 
I I I 



^ I I 
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(5X4) (4X3) (5X3) 

Figura 3-20 - Ilustragao da obtengao de um elemento de uma matriz num produto de duas matrizes 
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3.1.3 Pontos e referenciais 

Qualquer ponto no espago pode ser visto (designado) de diferentes formas consoante o referencial 
usado; trata-se sempre do mesmo ponto fisicamente mas e a sua descrigao que se adequa com o ponto de 
vista (referencial). Admitindo dois referenciais designados por R e N respectivamente, um mesmo ponto q 



R. 



pode ser expresso num e noutro por q = 



Qx 



R. 



R. 



e^q = 



N 



Qx 



N 



N 



(Figura 3-21). 





Figura 3-21 - Um ponto q visto de dois referenciais diferentes 

A relagao entre ^q e ^q, como se vera mais tarde, tem necessariamente a ver com a relagao de posigao 
e orientagao entre os dois referenciais, ou seja, da forma como se obtem um a partir do outro. 

Uma outra questao importante e a movimentagao de pontos. Movimentar um ponto no espago 
significa alterar-lhe as coordenadas, isto e, passar de uma posigao qi para uma posigao q2 visto do mesmo 
referencial; este processo designa-se por translagao no espago e, geometricamente, pode ser traduzido pela 
adigao/subtracgao de vector es como referido na secgao 3.1.2. 



q2 




Figura 3-22 - Translagao de um ponto 
Atentando para a Figura 3-22 podemos escrever que p = q2 — Qi ou que q^ = Qi + P • Assim, 
efectuou-se uma translagao representada pelo vector p e as novas coordenadas do ponto sao dadas por 



^2 = 



?2. 








Px 


\ 


= 


\ 


+ 


Py 


.\. 




[«1.. 




Pz 



. Fazer a translagao de um segmento de recta (Figura 3-23) implica calcular as 



novas coordenadas dos seus dois extremos e, nesse caso, ter-se-ia as seguintes relagoes q .^ = Q^i + P ^ 



1^1 
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<1b2 = qfii + p • 




Figura 3-23 - Translagao de um segmento de recta. 

Fazer a translagao de figuras mais complexas implicaria recalcular todos as novas posigoes de todos 
OS pontos relevantes. For exemplo, para calcular a nova descrigao (posigao) de um cubo, teriamos de calcular 
as novas coordenadas dos seus oito vertices apos a translagao. Claramente, este processo nao e interessante 
(em especial para transformagoes mais complexas que a translagao, como veremos mais adiante), e requer-se 
portanto uma forma alternativa e mais generica para determinar a nova posigao do cubo e de qualquer ponto 
nele contido. Essa alternativa passa pela definigao de um segundo referencial solidario com o objecto a 
mover. No instante inicial, antes da transformagao, os referenciais coincidem, mas apos a transformagao 
teremos ainda o referencial original (R) e o novo referencial (N). O processo ilustra-se na Figura 3-24. O 
ponto ^q assinalado traduz as coordenadas de um dos vertices (escolha arbitraria) no novo referencial, mas 
sao tambem as coordenadas desse mesmo ponto, em R, antes de haver qualquer translagao! Apos a 
translagao, no referencial N, solidario com o objecto, essas coordenadas mantem-se, mas no referencial que 
foi deixado para tras (R) esse ponto tem agora as coordenadas ^q. A relagao entre essas coordenadas e 
obviamente dada por q = q + P • Note-se que o vector p esta descrito no referencial original (p = ^p), 
donde, em rigor, se deva procurar escrever q = q + p . 




Figura 3-24 - Translagao de um cubo e do referencial a ele associado. 

3.2 Transformagoes geometricas elementares 

3.2.1 Exemplos de transformagoes 

Pela experiencia fisica do dia a dia, e possivel conceber transformagoes geometricas diferentes da 
translagao, das quais a rotagao e o exemplo mais comum. Por exemplo, uma rotagao no espago 3D, em torno 
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do eixo dos zz, de um dado angulo a, Rot(z,a), ou uma translagao de valor a ao longo do eixo dos yy, 
Trans(y,a) - Trans(0,a,0), podem ser ilustradas do seguinte modo- 





Figura 3-25 - Ilustragao das transformagoes Rot(z,a)Q Trans(y,a). 

Na verdade, e como facilmente se deduz da Figura 3-25, no espago a tres dimensoes ha seis 
transformagoes geometricas independentes, 3 translagoes e 3 rotagoes elementares- Trans(x,a), Trans(y,a), 
Trans(z,a), Rot(x,a), Rot(y,a) e Rot(z,a) . Naturalmente, e como se vera mais adiante, transformagoes 
sucessivas resultam numa outra transformagao decomponivel nas seis transformagoes elementares. 

3.2.2 A notagao matricial para representar transformagoes de um ponto a duas dimensoes 
3.2.2.1 Transformagao geometrica generica 

Se atentarmos ao caso da translagao no espago (a 2D para simplificar), poderemos escrever o 
seguinte- 

2/l = y + Py 

OU, em notagao matricial- 



-x^- 




X' 


+ 


Px' 


M 




[y\ 




[Py\ 



Podemos todavia admitir um caso de transformagao geometrica, linear, absolutamente generica onde 
cada nova coordenada possa depender nao so de um parametro independente, mas tambem de todas as 
coordenadas originals. Uma expressao desse genero seria dada por- 

' x^ — ax + by + pr^ 
y^ ^ ex + dy + Py 

ou, em notagao matricial. 



rx^i 




a b 


' X' 




\Px] 


Vi, 


— 


c d 


y 


+ 


Py_ 




a b 


irada indicada. 


c d 



, e por p o vector usado como termo 



independente na expressao anterior. Rapidamente se verifica que a transformagao de translagao e obtida 

fazendo T identidade e p o vector de translagao. Podemos assim considerar um conjunto de situagoes para 

valores de T e de p, e procurar relaciona-los com transformagoes geometricas conhecidas. Vamos 

[01 
primeiramente admitir um conjunto de situagoes onde temos o caso particular de p = = 







, ou seja, sem 
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translagao. 

3.2.2.2 Matriz identidade (transformagao nula) e sem translagao 





[1 


0" 




\X^] 




[1 


0] 


\X] 




[0" 




[XI 


se T = 






vira 




— 








+ 




— 






U 


1 




M 




u 


1 


y 




u 




y 



— , ou seja, nao ha transformagao geometrica alguma; 



a matriz identidade nao introduz transformagao geometrica. 
3.2.2.3 Reflexao em relagao a um eixo (simetria axial) 

se T = 



-1 




[^i] 




[-1 0] 


rxi 




\—x^ 


1 


vira claramente 


.?/i. 


— 


1 


y 


— 


y 



ou geometricamente- 



y 



Pi=(xi,yi) 
=(-x, y) 



P=(x,y) 



X 



Figura 3-26 - Simetria axial 



3.2.2.4 Reflexao em relagao a origem (simetria central) 



se T = 



[-1 







rx^i 




[-1 


1 


' X 




—X' 





-1 


vira 


.2/1. 


— 





-1 


y 


— 


-y 



ou geometricamente 



y 



Pi=(xi,yi) 

=(-x, -y) 



P=(x,y) 



X 



Figura 3-27 - Simetria central 



3.2.2.5 Factor de escala 

Uma transformagao curiosa e dada por T = 









a 


01 






por T = 


1 


, que re 


«A/-| 




a 


x 


1 


ax' 


yi. 


— 





1 


y 


— 


y 
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Sobre um ponto poderia ter efeitos aparentes de uma translagao, mas nao e de facto uma translagao. 

Basta pensar quando aplicada a um objecto mais complexo como um segmento de recta. Seja por exemplo o 

[3 01 
segmento delimitado pelos pontos A(l,l) e B(2,2) e seja T = 



A^ = 



3 
1 



5' = 



1 

3 
1 



. E imediato concluir que- 



Geometricamente a operagao pode ser representada como ilustrado na Figura 3-28. 



y 




Figura 3-28 - Transformagao de escala aplicada ao segmento AB 



A transformagao anterior nao e uma translagao porque nao ha nenhum vector que adicionado a 
ler ponto de AB resulte no ponto respectivo de AB', 

verificar por outro lado que o novo segmento e mais longo! 



qualquer ponto de AB resulte no ponto respectivo de AB', ou em simbolos ^Bj. : V ^r'P' ~ P + ^ • Basta 



3.2.2.6 Rotagao de 90^ 
"0 -1" 



Se T = 



de coordenadas- 



1 



entao temos uma transformagao de rotagao de 90° em torno da origem do sistema 



X, 



Vi 



-1 

1 



X 



O fenomeno e melhor ilustrado com um exemplo. Se pensarmos num triangulo com os seguintes 
vertices A(2,l), B(2,-l) e C(4,0), apos as transformagoes vira- 



A' = 



[0 


-11 


[2" 




[-1" 




[0 


-11 


f ^ " 




[11 


1 





1 


— 


2 


, 5' = 


1 





-1 


— 


2 





[0 


-11 


[4 




[01 


C" = 


1 








— 


4 



que se representa geometricamente na Figura 3-29. 
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Na \ 




B 

Figura 3-29 - Rotagao de 90° no piano em torno da origem. 

3.2.3 Matriz rotagao para um caso geral 

Pode-se verificar que a matriz de rotagao de 90° vista anteriormente e compativel com o seguinte- 

"cos 90° -sin 90°^ 
sin 90° cos 90° 



T = 



Poder-se-a induzir que uma matriz de rotagao generica seja dada pela seguinte expressao^ 



T = 



cos — sin ^ 
sin cos 



CO -SO 
SO CO 



Vamos provar que assim e. Seja um dado ponto no piano com coordenadas cartesianas (x, y) e 
coordenadas polares (7, 9). Posteriormente, e aplicada a esse ponto uma rotagao de valor (|) em torno da 
origem, resultando no ponto de coordenadas {xi, yi). 




Xi X 
Figura 3-30 - Rotagao generica de um ponto no piano 

A partir da Figura 3-30 e possivel extrair as seguintes relagoes^ 

x^ = / cos ( ^ + ) = / ( COS cos (/) — sin sin ) 
y-^ — I sin {0 + (j)) — l{ cos (j) sin + sin cj) cos ) 



como 



X — I cose/) 
y = IsmcJ) 



vira- 



' x^ = X cos — y sin 
y-y — X sin + y cos 



e finalmente em notagao matricial^ 
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X, 



Vi 



cos — sin 
sin cos 



CO -SO 
SO CO 



3.2.4 Limitagoes da matriz de transformagao para representar a translagao 

A translagao tern um efeito independente das coordenadas. Esta associada ao termo p = 



Px 

Py 



indicado nas expressoes mencionadas a partir da secgao 3.2.2.1. Porem, seria vantajoso, pelo menos do ponto 
de vista computacional, ter uma forma de representar uma transformagao geometrica de forma compacta e 
elegante, em vez de uma matriz e um vector independente. 

3.3 Coordenadas homogeneas 

3.3.1 Introdugao de componentes adicionais na matriz de transformagao 

Uma solugao para a questao anterior (secgao 3.2.4) obtem-se observando a expressao 
. Basta conceber uma forma alargada de definir as coordenadas de um vector e 



resc 


rev( 


a b 
c d 

ir enta 


x 

y 

0- 


+ 


Px 

Py 



a 


b 


Px 


X 


c 


d 


Py 


y 








1 


1 



^1 
yi 
1 

Os termos introduzidos fazem surgir uma igualdade adicional (l=l), que e verdadeira, e nao altera 
em nada o conhecimento do sistema, mas tem a vantagem de integrar numa unica matriz os efeitos da 
rotagao e de uma translagao (pode ainda representar outros efeitos irrelevantes neste momento). 

As coordenadas resultantes (com o termo unitario adicional) sao designadas coordenadas 

homogeneas, e este caso e uma situagao particular da definigao geral de coordenadas homogeneas- se 

kx' 



P = 



, entao a variante homogenea e dada por p, = 



ky 
kz 
k 



. Nestes capitulos dedicados ao estudo dos 



sistemas de coordenadas usa-se o caso particular de k=l. 

A matriz de transformagao (homogenea) e assim constituida por secgoes com significados especificos- 



Componente 
de rotagao 



yi 
1 



cos6^^ -sin/^ 

\^n6__cos6j 






Componente 
de translagao 



Figura 3-31 - Componentes da matriz de transformagao a duas dimensoes. 
Assim, uma rotagao pura, no piano, traduz-se pela expressao- 
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Rot(O) = 



cos^ 


— sin^ 


1 

1 


sin^ 


cos^ 


1*^ 








1 1 



e uma translagao pura, no piano, pela expressao^ 



Trans {p^.Py) = 



1 


Px 


1 


Py 





1 



3.3.2 Transformagoes compostas - produtos de matrizes de transformagao 

Uma transformagao geometrica transforma um ponto noutro; portanto, uma sucessao de 
transformagoes traduz-se na multiplicagao das diversas transformagoes. Basta relembrar a propriedade 
associativa da multiplicagao de matrizes para o demonstrar: 

P' = T^ (-(Ts • (T2 • (T, • p)))) = (T^ -T, . T2 • Tjp = T . p 

Assim, uma transformagao composta e ela mesma uma transformagao geometrica. 

Observe-se porem que a ordem das multiplicagoes (operagao das transformagoes) nao e 
necessariamente comutativa. E-o para as translagoes puras e tambem para as rotagoes puras no piano (no 
espago nao e!), mas nao o e para transformagoes genericas. De seguida demonstram-se estas situagoes uma 
por uma. 

3.3.2.1 Sucessao de Translagoes (comutativo) 



Sejam duas translagoes^ 



T^ = Trans (^a^^ay) — 



Rapidamente se verifica que- 



T T = 



1 





a^ 





1 


ay 








1 



e T2 = Trans {b^^by) = 



1 
1 







1 Ola, 
1 \ ay 

1 1 

i 


1 





1 


by 


= 


1 





a, + 6, 

1 ay -\- by 

1 








1 



= T T 



3.3.2.2 Sucessao de Rotagoes no piano (comutativo) 



Sejam duas rotagoes no piano- 



T^ = Rot[0^) = 









cos^^ 


— sin 6-^ 





sin^^ 


cosO^ 











1 



e T2 = Rot[0^ 



cos ^2 — sin ^2 
sin Or, cos Or, 











Por facilidade de notagao, convencionando as abreviagoes CO- 
duas transformagoes resulta em- 



= cos 0- e SO- = sin 0- , o produto das 
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CO^ 


-SO^ \ 


CO, 


-so. 





T T = 


se^ 


ce^ 


so. 


CO, 










1 1 








1 



CO^CO, — SO^SO, —CO^SO, — so^co, 
SOJJO, + CO^SO, —SO^SO, + COXJO, 











ou ainda, usando as regras do seno e do co-seno da soma de angulos- 



cos(6>^ + 0,) 
siii(6>^ + 0,) 


cos(6>^ +^2)0 





j 1 



T T = 



Tambem se ve claramente que a operagao e comutativa, e geometricamente corresponde a rodar 
incrementalmente os sucessivos angulos de rotagao. 

3.3.2.3 Sucessao de Translagoes e rotagoes (nao comutativo) 

Menos tolerante e o caso da ordem de aplicagao de translagoes e rotagoes. De facto, tambem se 
demonstra com grande facilidade que a operagao nao e comutativa. 
Sejam as transformagoes- 



T^ = Trans{p^,Py) = 



1 





Px 





1 


Py 


o" 


"0" 


"T 



e T. = Rot{0) = 



cos^ — sin^ I 
sin^ cos^ I 
"""0 



rTi 



Como se espera, ate da propria definigao de transformagao geometrica, e imediato obter o seguinte- 



T^ •T2 = Trans{p^,Py)Rot{0) = 



1 





Px 





1 


Py 








1 



cos^ 


— sin^ 


1 


sin^ 


cos^ 











i 1 

i 



COS — sin ^ 
sin cos 











Px 

Py 

"T 



Mas, por outro lado, a operagao na ordem inversa resulta de forma bem diferente- 



T2 -T-^ = Rot {0 ) Trans {p^.Py) = 



cos^ 


— sin^ 





1 





Px 


sin^ 


cos^ 








1 


Py 








1 








1 



cos^ 
sin^ 


— sin^ 
cos^ 


Pa- cos — Py sin 
Prj. sin -\- Py cos 








1 
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3.4 Matrizes de transfer magao a 3 dimensoes 



3.4.1 Generalizagao dos conceitos para 3 dimensoes 



Os conceitos abordados no caso do piano sao, com relativamente pouco esforgo, generalizaveis para o 
espago a tres dimensoes. A translagao tem mais um grau de liberdade e portanto havera mais uma 
coordenada nos vectores. Todavia, a rotagao deve agora ser definida em torno de um eixo, havendo, por isso, 
3 tipos de rotagoes possiveis; as rotagoes no espago 3D apresentam portanto mais diversidade e 
complexidade do que no piano. 

Em coordenadas homogeneas um ponto e agora dado por- 

\x] 



P = 



3.4.2 Componentes da matriz de transformagao 

A matriz de transformagao para o espago 3D assume tambem as dimensoes apropriadas- 



T = 



a b c 


Px' 


d e f 


Py 


9 h i 


Pz 





1 



A sub-matriz R de T, R = 



a 


b 


c 


d 


e 


f 


9 


h 


i 



, representara agora todo o conjunto de rotagoes passiveis de 



afectar a transformagao como se descreve mais a frente. O vector p = 



Px 

Py 

Pz 



traduz naturalmente a 



translagao. 



Rot(z) 





Rot(x) 



Figura 3-32 - Rotagoes no espago a 3D. 

Como foi ja mencionado, a rotagao pode ser feita em torno de tres eixos distintos, como se ilustra na 
Figura 3-32. A variante mais intuitiva e a rotagao em torno dos eixo dos zz que deriva de imediato da rotagao 
do piano. As outras variantes sao menos intuitivas mas a sua demonstragao nao e de forma nenhuma 
complexa; bastara pensar na expressao usada para o piano a 2D e arranjar as matrizes de transformagao 
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adequadas. Assim vira^ 



Rot{z,0) = 



Rot{x,0) = 



Rot{y,0) = 



cosO -sinO 

sm6> cosO 

10 

1 

10 

cos6' -smO 

smO cosO 

1 

COS 6* smO 

10 

-sinO cosO 

1 



No caso de rotagoes compostas em torno de dois ou mais eixos a componente de rotagao (orientagao) 
da matriz de transformagao sera mais complexa do que o das rotagoes simples indicadas atras. 

A matriz de transformagao geometrica, homogenea, tem, alem das rotagoes e da translagao mais 
quatro termos (a ultima linha). Nesta abordagem os valores dessa linha so interessam ser [0 l], mas 
noutros contextos terao a importancia adequada, nomeadamente no tratamento geometrico de imagem 
digital; sao exemplos disso a perspectiva e o factor de escala global. 



Rota9oes 
Factor escala local 



T = 




Transla9ao 



A -^2 \ 



Perspectiva / 
projec9ao 




Factor de escala 
global 



Figura 3-33 - Componentes da matriz de transformagao a 3D. 

3.4.3 Interpretagoes do que significa a matriz de transformagao. 

E possivel individuar tres interpretagoes/significados principals de uma matriz de transformagao, que 

se resumem de seguida^ 

• Indica as transformagoes geometricas operadas sobre um ponto para o levar para outro local 
geometrico- q^ = T • qg . Este facto traduz tambem o movimento imposto a um ponto, sempre 

dentro de um mesmo referenda! Nao sao aqui obvias todas as implicagoes da transformagao se o 
objecto for um ponto, em especial as componentes de rotagao. 
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Figura 3-34 - Significado de ^T* movimentagao de um ponto 

• Relaciona as coordenadas de um mesmo ponto fisico em dois referenciais diferentes, ou 
seja- q = T^ • q . Muda-se o ponto de vista, e no caso anterior mudava-se o ponto! 





Figura 3-35 - Significado de ^T: movimentagao (criagao) de um referencial 

Transformagao de um referencial (R) noutro referencial (N)' ^Tn. Trata-se da criagao de um novo 
referencial por translagao e rotagao. Para tentar criar uma melhor imagem do processo, bastara 
pensar que havia um segundo referencial N inicialmente coincidente com o referencial R mas 
solidario com o seu ponto de origem; a esse ponto foi depois aplicada a transformagao levando 
consigo o referencial N. A matriz de transformagao representa todas as componentes de posigao e 
orientagao de um novo referencial N em relagao a um referencial original R. Isto e, e possivel 
identificar na matriz ^Tn os quatro vectores que indicam a orientagao (tres dos quatro vectores) e 
a posigao cartesiana (um vector) do novo sistema de coordenadas. Na expressao seguinte xn e o 
vector que indica a direcgao do novo eixo dos xx em relagao a base canonica do sistema R, e yN e zn 
OS vectores para as direcgoes dos novos eixos dos yy e dos zz respectivamente- 



R 



T = 



hi 


^12 


^13 


Px 


^21 


^22 


^23 


Py 


^31 


^32 


^33 


Pz 















"6" 






T 



"T" 



^^ 





Figura 3-36 - Significado de ^T: relagao entre dois referenciais. 
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3.4.4 Pos-multiplicagao e pre-multiplicagao de matrizes de transformagao 

Foi visto anteriormente que a ordem de multiplicagao das transformagoes era importante (secgao 
3.3.2) porque se fosse alterada o resultado seria diferente. Ou seja, se uma transfer magao ^Ti for seguida no 
tempo de uma transformagao ^T2, entao isso equivale a ter uma transformagao global ^T =^T2 • ^Ti. Ou seja, 
a transformagao final resulta da pre-multiplicagao das transformagoes aplicadas sucessivamente no tempo. 

Porem, p6e-se a questao- e o que significara a transformagao ^T' =^Ti • ^T2? Isto e, em que e que 
resulta a pos-multiplicagao de transformagoes? O problema compreende-se melhor com um exemplo, que se 
faz no piano a 2D para mais facil visualizagao. 

Seja uma transformagao Ti=Rot(45°) e uma transformagao T2=Trans(x, a) que usaremos para criar 
novos referenciais. A primeira situagao que experimentamos e Ta = T2T1. Significa que primeiro rodamos o 
referencial e em seguida Ihe aplicamos uma translagao, como se ilustra na Figura 3-37, do lado esquerdo. A 
segunda situagao sera designada por Tb = T1T2 e significa que primeiro e aplicada uma translagao segundo o 
eixo dos xx e depois uma rotagao em torno da origem. O resultado e o ilustrado no lado direito da mesma 
figura. No primeiro case, T2 foi pre-multiplicado a Ti, no segundo case, T2 foi pos-multiplicado. 

TB=TiT2=Rot(45°)Trans^,a) 



y 






y 



TA=T2Ti=Trans(x,a)Rot(45°) 



X 



45° 



^y 



10 



<r 



-> 



X 




Figura 3-37 - Diferengas entre pre- e pos-multiplicagao de transformagoes. 

Em ambas as situagoes, as transformagoes foram realizadas em relagao ao referencial original (xy). 
Imagine- se porem uma alternativa que seria aplicar as transformagoes em relagao a cada referencial recem- 
criado. Ou seja, sao usados os referenciais intermedios para as novas transformagoes a aplicar. Digamos 
entao o seguinte- aplicar a rotagao (no unico referencial ainda existente) e depois a aplicar translagao ao 
longo do referencial resultante da rotagao. Geometricamente o processo pode ser ilustrado como na figura 
seguinte- 




Figura 3-38 - A segunda transformagao (translagao) foi realizada no novo referencial. 

O resultado da Figura 3-38 e muito interessante pois coincide com o resultado do segundo case da 
Figura 3-37 (lado direito), isto e, Tb = T1T2, ou seja, a pos-multiplicagao da matriz. Prescinde-se de 
demonstragao formal, mas podemos afirmar o seguinte^ a pre-multiplicagao de uma transformagao por outra 
equivale a aplicar esta segunda no referencial global; a pos-multiplicagao de uma transformagao por outra 
equivale a aplicar esta segunda no novo referencial. 
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Segue-se um problema mais complexo usando o enunciado anterior. Determinar o novo referencial 
depois de translacionar o original de uma unidade em cada eixo, depois roda-lo 90° em torno do novo eixo dos 
yy, translacionar 1 unidade no novo eixo dos xx, e depois translacionar 1 unidade negativa no eixo dos zz do 
referencial original. 

A transformagao e dada pelo seguintes passos- 



Passo 4 



Passo 1 



Passo 2 



Passo 3 



T= Trans(0,0,-1) Trans(l,l,l) Rot(y,90°) Trans(l,0,0) 

Note-se que o passo 4 foi uma pre-multiplicagao e os restantes (2 e 3) foram pos-multiplicagoes. 
Graficamente o processo percorreu as seguintes fases- 




Figura 3-39 - Os quatro passos da transformagao T=Trans(0,0,-l)Trans(l,l,l)Rot(y,90°)Trans(l,0,0) 



Do ponto de vista matricial obtemos a seguinte expressao- 



T = 
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A interpretagao da matriz final e directa e confirmavel pelo diagrama da Figura 3-39- o novo eixo dos 
XX aponta no sentido contrario do eixo dos zz original; o novo eixo dos yy aponta no mesmo sentido do eixo 
dos yy original, e o novo eixo dos zz aponta no sentido do eixo dos xx original. Finalmente, a origem do novo 
sistema de coordenadas esta no ponto (l,l,-l) medido no referencial original. 

3.4.5 Transformagoes inversas. 

A obtengao de um novo ponto pela aplicagao de uma dada transformagao geometrica pressupoe que o 
processo inverso e igualmente possivel- trata-se tao simplesmente de obter um ponto (o original) a partir de 
outro (o que era designado de novo). Matematicamente o processo traduz-se do seguinte modo- 

Pi = T • Po ^ T-i • p^ = po 

Ou seja, pelo recurso a inversa de uma matriz, foi possivel inverter o processo de transformagao 
geometrica. Deste modo, a inversa da matriz de transformagao e tambem ela, necessariamente, uma matriz 
de transformagao. 

Como transformagao que e, a transformagao inversa assume todos os significados ja conhecidos. Em 
particular, realce-se a transformagao de referenciais de onde sai a expressao- ^ ^"^ "^ — ^ "^"^ —^ 



'■N 
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Nrp Rrr -1 

Ar= An 




Figura 3-40 - Transformagao inversa 

Na Figura 3-40 pretende-se ilustrar o processo de transformagao inversa e algumas relagoes entre 
pontos. O ponto po sobre um dos eixos no referencial R tern o seu correspondente, apos a transformagao 
directa, no ponto pi sobre o eixo do novo referencial, N. Note-se que po e pi podem ser vistos como pontos 
diferentes num mesmo referencial (esquecendo o outro referencial), ou cada um no seu referencial como 
resultado de uma transformagao de referencial. A partir da Figura 3-40 podemos ainda escrever uma 
panoplia de expressoes que poderao ajudar a compreender melhor as diversas relagoes. 

p, = T • p„ , T 1 • p, = p„ 



A^ 



N 



q =" T 



^i.-% 



Rq =^ T-1 -^ a =^ T 



N 



q 



1^0 ^R 1^0 ' 



p, =^ T^ -^ p, , etc. 



Note-se que nas relagoes anteriores se tem T = ^Tn. So uma questao de contexto permite dispensar os 
indices; na verdade, quando nao pensamos no significado de transformagao de referenciais, nao faz sentido 
falarmos de referenciais, e ai, os indices que os descrevem (R,N,...) nao tem utilidade particular. Ou seja, 
quando nas expressoes acima intervem um unico ponto, mas visto de referenciais diferentes (^q e ^q, por 
exemplo), e necessario indicar a ordem da transformagao (de R para N ou de N para R). Quando 
relacionamos dois pontos diferentes num mesmo referencial (po e pi por exemplo), em geral a transformagao 
entre eles nao carecera de indices desde que nao haja ambiguidade. Em caso de duvida ou de potencial 
ambiguidade sugere-se o uso dos referidos indices! 

A matriz de transformagao tem propriedades particulares que permitem definir uma regra muito 
expedita para calcular a sua inversa. De facto, se uma matriz transformagao for dada por: 

Px 



T = 



ROT 







Py 

Pz 

~r 



X y z 

o""T "o 



entao a sua inversa sera dada por: 



T-i = 



(ROT) 



T 











-px 

-py 

-p z 



Note-se o uso da seta (redundante) para reforgar a lembranga a natureza dos objectos em causa. 
Como dito anteriormente, o seu uso nao era aqui obrigatorio, contudo a sua presenga recordara que, por 
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exemplo o produto p-x e um produto interno (escalar) de vectores. 

3.4.6 Grafos e equagoes de transformagao 

Um dos problemas mais frequentes em robotica industrial, e na automagao em geral, consiste em 
determinar a posigao relativa entre um componente e um seu sub-componente, sabendo as suas posigoes, em 
relagao a um referencial comum (como por exemplo a bancada de trabalho). Por outras palavras, qual deve 
ser a transformagao a aplicar ao sub-componente para o encaixar num local bem definido no componente 
principal. Para melhor ilustrar a questao, imagine-se um parafuso (ou pino) que queremos encaixar numa 
dada cavidade; note-se que a localizagao do pino e da cavidade sao conhecidos. Apos a identificagao das 
partes, devem definir-se referenciais associados a cada um deles e, a partir dai, procurar as relagoes entre os 
referenciais. No exemplo do pino, Figura 3-41, os referenciais associados devem ser de tal forma que, na 
posigao final, apos o encaixe, os eixos deverao todos coincidir, por que e esse o objectivo da montagem 
(assembJmg). 



An 




ys 



Yr 



R 




N 



Figura 3-41 - Problema da insergao geometrica de um pino numa cavidade 

Do grafo da Figura 3-41 podemos escrever a seguinte relagao- ^Tn = ^Ts • ^Tn. Ha varias formas de 
demonstrar essa relagao mas eis uma das formas mais expeditas- seja um ponto q qualquer no espago com as 
diversas coordenadas ^q, ^q e ^q consoante o referencial de onde e visto. Do exposto na secgao 3.4.3 podemos 
escrever sucessivamente- 

Sq = sTn Nq 

^q = ^Ts ^q 
Combinando as duas expressoes vem^ 

^q = i^Ts (STn ^q)= (^Ts ^Tn) ^q 
Comparando a expressao anterior com ^q = ^Tn ^q vira finalmente- 

i^Tn = i^TsSTn 
Nesta expressao, e relembrando a situagao da Figura 3-41, e o grafo de transformagao, verifica-se que 
ha um termo desconhecido, trata-se de ^Tn, dai a expressao de designar por equagao de transformagao. A 
sua resolugao e todavia muito simples, recorrendo apenas a algebra de matrizes^ 

sTn=^Ts-i-^Tn 

Note-se que a transformagao ^Tn nao traduz a trajectoria que deve fazer o pino para chegar ao 
encaixe; traduz apenas uma relagao geometrica de posigao e orientagao que servira de base ao calculo do 
eventual movimento/trajectoria, que sera tema a abordar noutro capitulo. Mais ainda, ^Tn traduz a posigao e 
orientagao da cavidade como vista do referencial do pino, isto e, a acgao de controlo ou geragao do movimento 
prescindira do referencial global R, e no pino que tudo comega. 

Prop6e-se ainda um outro exemplo mais elaborado onde se pretende descobrir a relagao entre o 



Sistemas de Coordenadas 



3-21 



Robotica Industrial - V. Santos 



end-effector de um manipulador e o ponto de contacto com um objecto a pegar. A Figura 3-42 mostra uma 
situagao possivel onde se assinalam os diversos referenciais- W - referencial global de trabalho (como a 
bancada ou sala), R - referencial da base do robot (localizagao da base do robot na bancada), H - referencial 
do end-effector (depende do estado corrente das diver sas articulagoes do robot), O - referencial do objecto a 
pegar (localizagao do objecto sobre a bancada), G - referencial do ponto de contacto no objecto (local onde o 
end-effector devera estabelecer contacto, como por exemplo o ponto central de uma face do objecto cuja 
descrigao geometrica e perfeitamente definida e conhecida). O grafo de transformagao e concebido levando 
em linha de conta que e no ponto G que se pretende o objectivo da operagao. 





Figura 3-42 - Transformagoes geometricas de um processo simples de manipulagao 

A partir do grafo de transformagao podemos escrever a equagao de transformagao cuja variavel 
(termo desconhecido) e ^Tg- 



wTr • RTh • hTg = WTo • oTg 



Finalmente sai a expressao final: 



hTg = ^Th-1 • wTr-1 • WTo • oTg 
3.4.6.1 Exemplo de uma montagem vista do referencial da pega 

Para terminar esta secgao, prop6e-se um exemplo numerico de um processo de montagem que 
consiste em determinar a transformagao a aplicar no paralelepipedo, e do seu ponto de vista, de tal modo 
que encaixe na pega mae ao longo das arestas assinaladas com uma seta a carregado. Escolheram-se os 
pontos A e B para origem dos referenciais respectivos e assinalaram-se os eixos como indicado para 
satisfazer os requisitos de alinhamento final. 







R 




A 



Sabendo que ^ A — 



Figura 3-43 - Exemplo de montagem. 

8 
Q ^B — 2 determinar a transformagao necessaria a aplicar a pega, do 
-2 



R 
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seu ponto de vista , para ela encaixar, isto e, determinar ^Ta. O grafo de transformagao e o ilustrado, e dele 
saira de imediato que ^Ta = ^Tb"^ • ^Ta. A partir dos pontos dados, e observando a orientagao dos eixos dos 
sistemas ilustrados, e imediato concluir o seguinte^ 

"0 -1 8" 



R 



T^ = 
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T = 
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Portanto, e pelas propriedades da matriz de transformagao homogenea, podemos concluir que- 
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Para verificar que o procedimento esta correcto, experimentemos o resultado em dois pontos distintos. 
Atente-se porem as coordenadas e aos sistemas de coordenadas que se usam em cada caso! A transformagao 
^Ta e a transformagao a operar sobre o paralelepipedo, mas visto do seu proprio referencial. As coordenadas 
que resultam serao tambem no seu proprio referencial. Podemos verificar a posteriori o seu valor noutros 
referenciais conhecidos so para efeitos de confirmagao. Tome-se por exemplo o ponto B propriamente dito 
que, no seu referencial, tem as seguintes coordenadas- 

BB=[0 1]T 
Apos a transformagao em causa (^Ta), as suas coordenadas, sempre no referencial B e que 
designamos por ^B', serao dadas por- 

" 1 41 

10 4 

-10 8 

1 

mas, no referencial A, que ponto e este? Sabendo ^Ta (e consequentemente ^Tb), para qualquer ponto 
do espago e valida a seguinte relagao q = T^ -^ q =^ T~^ ^ 

Portanto, 



B-Q\ _B rj 
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e por conseguinte, B ' = T^ • B ' , ou seja 
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como seria de esperar, visto este ponto nao ser mais do que a origem do sistema A. 

Um segundo teste pode ser feito a um outro vertice do paralelepipedo ilustrado na Figura 3-43. No 
referencial B, temos o ponto indicado por qo, que tera como coordenadas nesse referencial ^qo. Esse ponto vai 
ser movimentado para a posigao qi, que tera coordenadas ^qi ou ^qi, conforme o referencial. Admitindo as 
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dimensoes 2x4x3 para o paralelepipedo, teremos entao, como se pode observar da referida figura, o seguinte^ 

[41 



B 



% = 



Note-se que devera tambem este ser o valor para ^qi porque a localizagao qi o ponto de destino de qo 
aquando da transformagao. E por isso, qi visto de A tern o mesmo valor que qo visto de B, ou seja, ^qi= ^qo. 
Assim, para verificar esta igualdade, passemos a verificagao da transformagao para este outro vertice do 
paralelepipedo- 



B^ 



_B 



B 



a =^ T • a = 



Mas, pelo raciocinio ja executado anteriormente, 
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qi = T^ • qi = 



que resulta em ^qi= ^qo como se esperava. 
3.4.6.2 Exemplo de montagem vista do referencial global 

No exemplo concreto anterior pode ressalvar uma questao. A transformagao pretendida era suposta 
ser aplicada no referencial da pega a mover, tal como sucedeu. Porem, e igualmente legitimo procurar 
determinar a transformagao a aplicar mas visto do referencial global R. Reformulando, qual deve ser, vista 
de R, a transformagao a aplicar ao bloco que esta em B de forme que "encaixe" no referencial A? Vamos 
primeiro clarificar e distinguir esta situagao da situagao anterior (transformagao vista do bloco a mover). 

Primeira situagao- o objecto sofreu ^Tb e em seguida deve sofrer ^Ta para atingir ^Ta, isto e- 
^Tb-^Ta=^Ta. a segunda transformagao (no tempo), por ser vista do novo referencial (B), e pos-multiplicada a 
transformagao original. 

Segunda situagao- o objecto sofreu ^Tb e em seguida deve sofrer uma transformagao T2 para atingir 
^Ta. Todavia, T2 deve ser vista do referencial global R e por isso deve ser pre-multiplicada a ^Tb- 
T2-^Tb = ^Ta. Como T2 pretende transformar do referencial B para A, visto de R, vamos designa-la do 
seguinte modo T2=^Tb,a. 

Feita a distingao de situagoes podemos entao escrever- 



ou seja. 



Substituindo, vira- 



RTb,a-RTb = ^Ta 



RTb,a = i^Ta-i^Tb-1 
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Bastara agora aplicar aos pontos ja usados na situagao anterior e confirmar os resultados. 
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O ponto qo, tern no referencial R as coordenadas- 
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e o ponto ql, tern no referencial R as coordenadas- 
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q, =« T^ .- q, = 



Finalmente, e como se esperava, a transformagao operada sobre o ponto qo resulta no ponto qi, tudo 
visto do referencial R- 



8" 


4 




4 


2 


6 




8 


-2 


4 


— 


2 


1 


1 




1 



^T -^ n — 



12 


"8" 




4 


10 4 


4 




8 


-1 10 


2 




2 


1 


1 




1 



=%1 



3.5 Orientagao e angulos de Euler (RPY) 

3.5.1 A componente de orientagao numa transformagao 

Numa matriz de transformagao geometrica, como ja visto, ha uma sub-matriz que traduz a orientagao 
do novo sistema de coordenadas com respeito ao sistema de coordenadas anterior. Essa sub-matriz de 3x3 
contem na verdade os versores das tres direcgoes dos tres eixos. 

I Px 

ROT I py rx^ y^ 

I Pz " T"""""" o" 
o"""o" ^ 
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T = 
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h2 
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Essa orientagao e o resultado de uma sequencia de 3 rotagoes em torno de tres eixos distintos, que 
traduz os tres graus de liberdade rotacional que existem no espago. 

As sub-matrizes de rotagao (BOT na expressao anterior) apresentam algumas propriedades que se 
podem tornar uteis em certas circunstancias, nomeadamente as seguintes- 
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-1 



A sua inversa e igual a sua transposta- R = R 

As suas colunas sao ortogonais- c- • c • =0 

O seu deter minante e unitario- det(R) = 1 



► r 



z,j = l, 2, SAi^j 



3.5.2 Formas de expressar a orientagao 

Podendo efectuar rotagoes em torno de tres eixos (Figura 3-32) afigura-se um variado numero de 
combinagoes possiveis. Esse numero e aumentado pelo facto de cada rotagao em torno de um dado eixo poder 
ser feita em relagao ao referencial original ou ao novo referencial recem-criado. 

Aos angulos de rotagao em torno de cada um dos tres eixos chamam-se usualmente angulos de Euler 
e o seu significado depende da combinagao de rotagoes usadas. O numero de combinagoes distintas e de 12 e 
de seguida descrevem-se as duas mais usadas. 

3.5.2.1 Roll-Pitch-Yaw (RPY) 

A combinagao de angulos mais imediata e a de pensar a rotagao, em relagao a um referencial fixo, 
segundo os eixos x, y e z por esta ordem. Esta sequencia e frequentemente conhecida pelos termos ingleses 
Bon-Fitch-Yaw. 



Roll(v|/), Rot(z, y) 




Pitch(0), Rot(y, 0) 




Yaw((|)), Rot(x, (|)) 



Figura 3-44 - Rotagoes RPY e correspondencia usual num punho de mannipulador. 

Matematicamente a matriz de transformagao e obtida do seguinte modo- 

Rot(0,6>,V^) = RPY{(I),0,iIj) = Rot(^,'0)Rot(?/,6>)Rot(x,(/)) 
ou, apos desenvolvimento: 

\Cct)Ce -S(t)Cij + C(t)Sesij S(t)Sij + C(t)Secij o 

S(l)CO C(j)Ctlj + S(j)SOStlj -C(t)Sij + S(t)S0C^lj 

-so cosi) coci) 

1 

Usualmente tambem se definem as seguintes expressoes- 

Roll{(l)) = Rot(^,0) , PitchiO) = Rot(y,0) , Yawii/j) = Rot(x,'0). 



RPY{^A^) = 



3.5.2.2 Angulos de Euler (tipo II) 

Uma outra variante para os angulos de Euler muito usada, e a chamada tipo II (se bem que esta 
designagao varie muito com os autores). A sequencia e a de rotagao em torno do eixo dos zz, rotagao em torno 
do novo eixo dos yy, e finalmente rotagao em torno do novo eixo dos zz. Esta variante tambem se designa 
angulos de Euler tipo Z-Yn-Zn, onde o indice N lembra que se trata de transformagoes no novo sistema de 
coordenadas. 
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Rot(z, 6) 



Rot(z", y) 



Rot(y', (|)) 




Figura 3-45 - Angulos de Euler do tipo II (Z-Yn-Zn) 

Matematicamente a operagao pode ser expressa da seguinte forma: 

Eulerjj(0,(t),ilj) = Rot ( z, 6> ) Rot ( ?/, ) Rot ( z, V^ ) 

Apos expansao matricial, e relembrando da pos multiplicagao efectuada para a segunda e terceira 
rotagao no tempo, chegamos ao resultado^ 

C(t)COCtiJ - S(i)StiJ -C(i)Cesij - S(t)Cij C(t>se i 

S(t)Cecij + C(t)S^i; -S(t)Cosij + C(t)Cij S(t)Se i 

-SeCij SOSi; CO 1 

1 



Euler jj ( 6>, 0, '0 ) = 
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4. Cinematica Directa de Manipuladores 



4.1 Cinematica de um manipulador 



4.1.1 Definigao 



A cinematica de um manipulador e o estudo do conjunto de relagoes entre as posigoes, velocidades e 
aceleragoes dos seus elos. 

O estudo que aqui se inicia diz respeito apenas aos manipuladores serie, que alias e a categoria que 
inclui a grande maioria de manipuladores industrials e didacticos. Os manipuladores serie caracterizam-se 
pelo facto de todas as juntas ligarem dois e apenas dois elos consecutivos. 

A relagao entre o referencial de origem e o referencial da extremidade (mao) do manipulador e dada 
por uma transformagao ^Th que, todavia, nao da qualquer indicagao sobre as relagoes entre os elos 
intermedios. Desse modo, para fazer um estudo da cinematica, e outros, e necessario, antes de mais, definir 
sistemas de coordenadas associados a cada elo, ou seja, atribuir-lhe referenciais. Por outro lado, a relagao 
geometrica entre elos e traduzivel por uma matriz de transformagao ^ para ir de um extremo de um elo (junta 
ou base do robot) ate ao outro extremo do elo (a junta seguinte ou a extremidade do robot) far-se-ao 
translagoes e rotagoes. Em suma, um dado elo i tera associado a si a matriz de transformagao Ay, onde a 
primeira matriz, Ai, relaciona o primeiro elo com a base fixa, e a ultima matriz. An, relaciona o referencial 
da mao com o ultimo elo. E entao claro que ^Th = AiA2...An. A Figura 4.1 esquematiza as transformagoes 
associados a um manipulador de 3 elos. 




Ai 



R 




^Th = A1A2A3 



Figura 4.1 - Matriz de transformagao de um manipulador serie com 3 elos 

4.1.2 EspaQO das juntas e espago cartesiano 

O estudo da cinematica divide-se em dois tipos de problematicas^ localizagao da mao a partir das 
posigoes das juntas (cinematica directa), e determinagao das posigoes das juntas a partir da posigao da mao 
(cinematica inversa). 

Podemos assim definir dois espagos de variaveis- o espago das variaveis da juntas, ou simplesmente 
espago das juntas, e o espago cartesiano ou operacional. A dimensao do espago operacional e 6 (3 translagoes 
e 3 orientagoes) e o espago das juntas tem como dimensao o numero de juntas do manipulador. As operagoes 



Cinematica Directa de Manipuladores 



4-2 



Robotica Industrial - V. Santos 



do espago das juntas para o espago cartesiano nao apresentam qualquer ambiguidade, mas o contrario pode 
nao ser verdade. De facto, o espago das juntas e muitas vezes redundante, isto e, nem sempre e possivel 
estabelecer uma relagao univoca com o espago cartesiano, significando que varias configuragoes no espago 
das juntas resultam na mesma configuragao no espago operacional 
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juntas 
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Cinemdtica 
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Figura 4.2 - Cinematica directa e inversa, e natureza nao biunivoca da sua inter-relagao 

4.1.3 O algoritmo da Cinematica Directa 

Implementar a cinematica directa de um manipulador significa, portanto, determinar as relagoes que 
exprimem um ponto no espago cartesiano, r , em fungao de um ponto no espago das juntas, q , isto e 

Os passos ou algoritmo para definir tal relagao sao, essencialmente, os seguintes- 

• Colocar o robot na posigao zero (descrito adiante) 

• Atribuir um sistema de coordenadas a cada elo 

• Descrever as relagoes (translagoes e rotagoes) entre as variaveis das juntas e dos elos 

• Determinar as matrizes de transformagao Ai dos diversos elos. 

• Multiplicar os Ai e obter a expressao ^Th 

• Obter as coordenadas de posigao da mao 

• Obter as coordenadas de orientagao da mao 

4.2 Parametros de juntas e elos 

Para atribuir sistemas de coordenadas a um elo sera preciso levar em conta a sua propria geometria e 
as consequencias que tera no elo seguinte da cadeia. No intuito de obter uma forma coerente e pratica de 
determinagao desses sistemas de coordenadas, e necessario definir conceitos tais como o eixo de uma junta 
ou OS parametros cinematicos dos elos e juntas associadas. 

4.2.1 Eixo de uma junta 

O eixo de uma junta e o eixo relacionado com a simetria do movimento inerente a propria junta e que 
pode coincidir com o eixo de um ou outro elo ou mesmo ser-lhe ortogonal; de seguida descrevem-se as 
situagoes tipo. O eixo de uma junta fara parte do sistema de coordenadas associados ao elo, e convenciona-se 
que seja o eixo das coordenadas zz. 

Eixo de junta rotacional 

No caso de termos dois elos colineares, entao o eixo da junta coincide com o eixo longitudinal dos elos, 
como se ilustra na Figura 4.3 do lado esquerdo. Este tipo de arranjo de junta colinear rotacional e muito 
usado em punhos de manipuladores. No caso dos elos terem o eixo de rotagao perpendicular ao seu eixo 
longitudinal (Figura 4.3, lado direito), estamos em presenga de um arranjo muito comum para cotovelos, ou 
seja o eixo da junta e ortogonal. 
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Figura 4.3 - Eixo de junta colinear e ortogonal em juntas rotacionais 

Eixo de uma junta prisma tica 

Para juntas prismaticas a abordagem e semelhante. Existem os casos de junta colinear ou junta 
ortogonal, conforme se ilustra na Figura 4.4, do lado esquerdo e direito, respectivamente. 





Figura 4.4 - Eixo de junta colinear e ortogonal em juntas prismaticas 



4.2.2 Os quatro parametros de elos e juntas 

Um elo e um elemento rigido que mantem fixas as relagoes entre juntas sucessivas e pode ser 
caracterizado com um determinado numero de parametros geometricos/cinematicos no que diz respeito a 
transformagao geometrica que opera. Os elos intermedios sao delimitados por duas juntas; a que o precede 
na serie de ligagoes designa-se aqui por junta anterior, e a outra designa-se posterior ou seguinte. Excepgoes 
devem ser levadas em conta para os elos extremos do manipulador, onde so ha uma junta delimitadora. 
Apresenta-se de seguida uma definigao conceptual de cada um dos quatro parametros cinematicos, a qual se 
junta uma definigao formal que sera usada mais adiante, a proposito do Algoritmo de Denavit-Hartenberg. 
Para se compreender a definigao formal recorre-se a uma a simbologia propria, a saber^ 

Oi — Ponto de origem do sistema de coordenadas i 

zi n xi — Ponto de intersecgao entre o eixo zi e o eixo xi 

O , P — Distancia do ponto Oi ao ponto Pi medido ao longo do eixo xi 

A{xi^Zi)\y^ — Angulo medido da direcgao de xi para a direcgao de zi em torno do eixo yi 

Comprimento do elo (W 

Distancia medida ao longo da normal comum entre os eixos das juntas. Traduz o conceito de 
afastamento linear entre os eixos das juntas. Formalmente^- \ — (z^_i f] x^),0^ \^ . 



1 Alguns autores preferem usar a letra a para designar este parametro. 
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Distancia entre elos ou deslocamento de juntas (di) 

O deslocamento de juntas traduz, em geral, a distancia entre elos medida ao longo do eixo da junta 
anterior. Definigao formal- d^ — 0^_i , (^^_i fl 2:2)1^ 

Angulo de junta (OO 

Angulo definido normalmente entre o eixo de um elo e o eixo do elo seguinte. Definigao formal- 

Q- — A\x- . , x-\ 

Angulo de torgao do elo (ai) 

Angulo de torgao que o elo impoe desde o eixo da junta anterior ate ao eixo da junta seguinte. 
Definigao formal: a^ = Zlz-_-^ , zA 

4.2.3 Alguns exemplos de elos 

De seguida apresentam-se varias geometrias de elos com o intuito de ilustrar os diversos parametros 
que afectam a cinematica de um manipulador. A definigao dos sistemas de coordenadas nao e muito rigida a 
excepgao da definigao do eixo zz que coincide com o eixo da junta, como convencionado. O i3-esimo elo e a sua 
junta anterior (zz-esima) sao responsaveis pela definigao do sistema de coordenadas n que se considera 
solidario com o elo. O sistema de coordenadas (n-l) e aquele sobre o qual opera a junta zz e o respectivo elo n. 
Desse modo, o sistema de coordenadas (zero) e o primeiro de todos e refere-se a base fixa do manipulador. 

Regras adicionais serao propostas mais adiante de uma forma estruturada para a definigao do 
algoritmo de Denavit-Hartenberg. Em todos os casos seguintes, o elo e o iresimo da cadeia. 




Junta n ^n 



In 


^0 


dn 


= 


Gn 


= variavel 


an 


= 



Zn-l 



Figura 4.5 - Exemplo 1 de elo -juntas rotacionais paralelas 
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Junta n 



Zn-l 



In^ 


:0 




dn^O 




0n = 


= variavel 


an 


= 





Figura 4.6 - Exemplo 2 de elo^ juntas rotacionais paralelas com desalinhamento 



Yn-l 



Junta n 




Junta n+1 



In 7^0 

dn = 

9n = variavel 

an ^ (-90") 



Figura 4.7 - Exemplo 3 de elo^ juntas rotacionais ortogonais 



Junta n 




In^O 
dn^O 

On = variavel 
an ^ (-90") 



Figura 4.8 - Exemplo 4 de elo^ juntas rotacionais ortogonais e com desalinhamento 
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Junta n Yn-l 



ln = 
dnT^O 

0n = variavel 
an 7^ (+90^) 



Figura 4.9 - Exemplo 5 de elo^ juntas rotacionais ortogonais (2° tipo) 



Xn-1 




ln = 

dn ^ (variavel) 
0n ^ (+90") 
an ^ (+90") 



Junta n 



Figura 4.10 - Exemplo 6 de elo^ junta prismatica e rotacional, ortogonais 




Yn-l 



Xn-1 



Junta (n+1) 



In^O 

dn = variavel 

0n=O 

an 7^ (+90") 



Figura 4.11 - Exemplo 7 de elo^ junta prismatica e rotacional, ortogonais (2° tipo) 
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Parametros aparentes- 


In 


7^0 


dn 


= variavel 


Gn 


= 


an 


^0 (+90^) 



A trago mais grosso indicam-se os 
reals parametros nao contemplados de facto 
nos 4 parametros cinematicos aparentes 
acima indicados. 



Figura 4.12 - Exemplo 8 de elo. Geometria mais elaborada com juntas prismaticas ortogonais 



Xn-l 



, — • 
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e„o = +90° 




N( 


^n 




In 


X 


1 J 


untc 


i(n 


+1) 





Junta n 



Vn-l 



Parametros aparentes^ 

In 7^0 
dnT^O 

0n= 90^ + variavel 
an 7^ (+90^) 

A trago mais grosso indicam-se os 
reais parametros nao contemplados de facto 
nos 4 parametros cinematicos aparentes 
acima indicados. 



Figura 4.13 - Exemplo 9 de elo. Geometria mais elaborada com juntas rotacionais ortogonais 

Os casos representados na Figura 4.12 e na Figura 4.13 sao os mais complexos de todos os 
apresentados aqui, e uma aplicagao simplista das regras usadas nos casos restantes mostrar-se-ia 
insuficiente porque aparentemente faltaria um termo de translagao. Na verdade, uma escolha mais 
criteriosa de dois parametros permitiria obviar esse problema. Na referidas figuras ilustra-se a trago mais 
grosso (e de cor diferente) essas medidas a ter de levar em conta; bastaria repensar, por exemplo, os 
parametros dn e an. Note-se que em algumas situagoes, como e o caso da Figura 4.12, a definigao da matriz 
de transformagao e simples (translagoes e rotagoes simples e bem definidas), e prescindiria de todo este 
processo de o recurso aos parametros cinematicos. 

4.2.4 Os parametros cinematicos variaveis 

Obviamente que os parametros cinematicos nao sao sempre todos constantes, senao a transformagao 
geometrica seria constante, e portanto o manipulador imovel. Dos quatro parametros indicados dois estao 
associados a componente movel (juntas); sao as variaveis de junta. Se uma junta for rotacional, a variavel de 
junta e o angulo de junta 9i. Se a junta for prismatica, a variavel de junta e o deslocamento da junta, ou 
distancia entre elos, di. 

A tabela seguinte resume os conceitos mais importantes sobre os parametros cinematicos. 
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Parametro 


Simbolo 


Junta 
rotacional 


Junta 
prismatica 


Definigao formal 


Angulo de junta 


Oi 


variavel 


fixo 


0- — A(x- -, , X-] 

I \ 2 — 1 ' 2 / 


h-l 


Deslocamento de junta 


di 


fixo 


variavel 


d, = 0,_i , {z,_i fix,) 

^i— 1 


Comprimento do elo 


h (at) 


fixo 


fixo 


k — (^2-1 II ^2 ) 5 ^2 


X, 


Angulo de torgao do elo 


OCi 


fixo 


fixo 


a- — A z- -, , z- 

2 \ 2 — 1 ' 2 / 


X^ 



Tabela 4.1 - Tabela dos parametros cinematicos 

Para efeitos de uma abordagem generica, diz-se que o vector variaveis de junta e designado por q e 
dado pela seguinte expressao- 

0, <^ rotacional 



q = 



iT 



Ql Q2 '" ^n 



' ^2 = 



i <^ prismatica 



4.2.5 Transformagao ^'^Ay associada a um elo 

Depois do exposto e imediato concluir que o elo i, associado a sua junta i, realiza uma transformagao 
geometrica, dando origem ao referencial i+1, que pode ser decomposta nas quatro operagoes elementares- 

□ Rotagao 6i em torno do eixo da junta (zi-i) 

□ Translagao "longitudinal" ao longo do eixo do elo (xi) do seu proprio comprimento (li) 

□ Translagao "transversal" ao longo do eixo da junta (zi) do afastamento entre juntas (di) 

□ Rotagao ai do eixo da junta (zi) em torno do eixo longitudinal (xi) do elo 

Repare-se que estas transformagoes elementares surgem concatenadas em sequencia, e por esta 
ordem, se bem que as translagoes possam comutar entre si, o que significa globalmente obter-se uma 
transformagao final por pos-multiplicagao sucessiva, resultando na matriz ^'^Ayou mais simplesmente, Ay- 

A^ = Rot(^,6>jTrans(/^,0,0)Trans(0,0,c^jRot(x,aJ 





m -so, 
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SO^ CO^ 
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1 d^ 





Sa^ Ca^ 










1 
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1 
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-SOfla^ 


soM 


hco. 








A. = 


so, 






-COM 


hso, 



















1 







(4.1) 



Os elos de um manipulador sao numerados a partir da base e o primeiro elo (movel) e o elo numero 1 
que se segue a primeira junta, ou junta numero 1. A base fixa e designada o elo 0. Sistema de coordenadas 
(zero) sera aquele a partir do qual se faz toda a transformagao geometrica do manipulador. Ha 
frequentemente mais do que uma possibilidade de o fazer, conforme o interesse do problema. A Figura 4.14 
ilustra duas possibilidades alternativas (a segunda a tracejado) para definir o sistema de coordenadas inicial 
(zero) de um manipulador do tipo PUMA com 6 graus de liberdade- 6 juntas, 6 elos (moveis mais uma base 
ou elo O). Deve referir-se que haveria ainda varias outras possibilidades de escolher os sistemas de eixos. 



Cinematica Directa de Manipuladores 



4-9 



Robotica Industrial - V. Santos 



Joint 



Link 




Figura 4.14 - Elos e juntas de um manipulador do tipo PUMA. Assinala-se a tracejado uma alternativa para o sistema 

de referenda. 

4.3 Atribuigao de sistemas de coordenadas 

4.3.1 Exemplos simples de sistemas de coordenadas 

Apresentam-se agora dois exemplos de atribuigao de sistemas de coordenadas e a determinagao de 
parametros cinematicos de coordenadas em dois manipuladores simples com dois graus de liberdade cada. 
Antes de mais defina-se que a posicao zero de um manipulador (Zero ou Home Position) e aquela em que as 
variaveis de junta estao nos seus valores 0. Ou seja, as juntas rotacionais estao alinhadas com a referenda e 
as juntas prismaticas estao recolhidas. 

Um manipulador planar a 2 DOF 




Elo 





a 


1 


d 


1 


ei 





li 
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62 





I2 






Figura 4.15 - Sistemas de coordenadas e parametros cinematicos de um robot planar a 2 DOF 

O manipulador planar a 2 graus de liberdade {degrees of freedom - DOF) e o mais simples dos 
manipuladores interessantes, e a atribuigao de sistemas de coordenadas e relativamente obvia; bastara 
atender ao eixo das duas juntas, e o resto sai naturalmente. Outras configuragoes seriam possiveis mas sem 
vantagens adicionais. Podemos agora determinar as suas expressoes de cinematica directa usando a relagao 
(4.1) e fazendo as simplificagoes de escrita Ci = C9i e Si = S6i- 
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Ai = 



^'(O) C(0) 

1 



















kc, 






1 





A — 

' ^2 





1 










-^2 





h^2 


C2 





h^2 





1 











1 



Multiplicando as expressoes obtidas vira^ 



°T, =« T^ = 











l,C,] 





l,S, 


1 








1 



















h^2 





h^2 


1 








1 



R 



T = 








—C^S^ — S^C^ I2C1C2 — I2S1S2 + i^c^ 

-S^S^ + C-^C^ I2C2S1 + ^2*^2^1 + ^1*^1 

1 

1 



Que, fazendo C12 = C1+2 = C(9i+92), podemos simplificar em: 

S^2 ^12 ^2*^12 + ^1*^1 

1 

1 



R 



T = 



(4.2) 



Analisando esta matriz podemos desde logo individuar as coordenadas (x,y,z) do end-effector do 
manipulador. Dada a simplicidade do manipulador, era possivel obter estas mesmas coordenadas por analise 
geometrica directa como se demonstra na Figura 4.16. Porem, a matriz de transformagao alem de ser 
generica, possui mais informagao. Por exemplo, dela se extrai tambem que a orientagao do sistema de 
coordenadas da mao (xH,yH) aponta nas novas direcgoes dadas pelos vectores [C12 812]'^ e [— S12 Ci2]'^, 
respectivamente. Mais uma vez e claro que estas orientagoes tambem se deduziriam pela analise geometrica, 
mas nao de forma tao directa. 



Coordenada x do extremo do manipulador^ 

X = L-^ cos^^ + L^ cos(^^ + ^2 ) ~ A^i + ^2^12 

Coordenada y do extremo do manipulador^ 

y = L^ sin 0-^ + L^ sin ( ^^ -\- 0^^ — L-^S-^ + ^2*^12 




Figura 4.16 - Coordenadas para um manipulador planar a 2 DOF 
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Um manipulador nao planar a 2DOF 
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Figura 4.17 - Sistemas de coordenadas e parametros cinematicos de um robot de 2 DOF no espago a 3D 

O manipulador 2 DOF no espago 3D, embora simples, ja exigiu mais alguma atengao na atribuigao 
dos sistemas de coordenadas. Vejamos, por exemplo, o caso do referencial da base. Se xo nao tivesse a 
direcgao indicada e apontasse ao inves na direcgao simetrica de yo (indicado), e dada a direcgao apresentada 
por XI, o angulo de junta 6i (que se mede de xo para xi em torno de zo) teria de ter um termo constante que 
seria neste caso +90°, ou seja (6i+90°)! So assim se garantiria uma expressao correcta do referencial da mao 
em relagao ao referencial de origem (xo, yo, zo). Repare-se tambem que neste manipulador ja ha distancia 
entre elos, di = Li. 

As expressoes para obter a cinematica directa sao as seguintes^ 



K- 
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6'(90) 
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C^ s^ 

S^ -c^ 
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C(O) 
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C^ —S^ L^C^ 
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T = 



C^ s^ 
S^ -c^ 



1 












h 

1 



C^ -S^ 
















^2^2 







^2*^2 




1 










1 





6^2 C^ L^S^ + L^ 

1 



(4.3) 



Como esperado, os resultados sao um pouco mais complexos, mas mesmo assim verificaveis por uma 
analise geometrica. Por exemplo, observa-se que a coordenada z e dada pela soma L^S^Li. Se 62 for maior 
que zero e menor que 90°, ou seja, quando a junta 2 "levanta" o elo que Ihe sucede, ve-se que a coordenada z 
da posigao de repouso Li (como indicado na Figura 4.17), e adicionado um termo proporcional ao 
comprimento do segundo elo afectado do seno do angulo da sua orientagao. Outras observagoes similares se 
poderiam fazer. 
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4.3.2 Algoritmo de Denavit-Hartenberg 

Nos exemplos anteriores, a atribuigao dos sistemas de coordenadas foi muito empirica, tendo-se usado 
o eixo da junta e procurado que os diversos eixos x saissem sempre colineares para facilitar a definigao do 
angulo de junta, conforme definigao ja referida na secgao 4.2.2.; obter as expressoes da cinematica directa a 
partir dos parametros tabelados foi feito sem dificuldades de maior. No entanto, se os manipuladores se 
complicarem o procedimento complica-se e dever-se-a recorrer a uma metodologia mais sistematica. O 
algoritmo de Denavit-Hartenberg (algoritmo D-H) propoe essa metodologia muito bem estruturada para, no 
algoritmo da cinematica directa, obter os sistemas de coordenadas e as transformagoes associadas a cada elo 
de um manipulador. Para ser aplicado, as juntas tem de estar numeradas por ordem crescente, comegando 
pela base do manipulador. Pode ser dividido em 4 etapas fundamentals que se subdividem em varios passos 
elementares repetidos parcialmente em ciclos, consoante o numero de elos do manipulador. Na Tabela 4.2, 
que descreve o algoritmo, admite-se que o manipulador tem n juntas e para ele se definirao n+1 sistemas de 
coordenadas, sendo o ultimo o associado a mao ou garra. 



1 


Estabelecer o sistema de coordenadas (xq, yo, Zq) na base de suporte, com Zq ao longo do eixo 
da junta 1 . Convencionar Xq e yo de forma conveniente. 






For i=1 to n-1 


2 


2.1 


Definir eixo junta i e alinhar Zj com eixo da junta i+1 


2.2 


Definir Q (origem do sistema de coordenadas) de um dos seguintes modes: 


2.3 


Intersecgao de Zj com Zj.i 
Intersecgao da normal comum entre Zj e Zj.i com Z\ 


2.4 


Definir Xj = ±(Zi.i x Zj), ou ao longo da normal comum a Zm e Zj quando sao paralelos 


2.5 


Definir yi = Zj x X| 






Next i 


3 


Estabelecer o sistema de coordenadas da mao On (o ultimo). Normalmente, a junta n e 

rotacional: 
Zn e colinear com Zn-i e a apontar para "fora" 
Xn normal a Zn e Zn-i 
yn de acordo com o sistema directo usual 






Determinar parametros de elos e juntas 
For i = 1 to n 


4 


4.1 


d^ = 0,_i , {z^_i n X, ) ^ ; e a variavel de junta se for prismatica 


4.2 


k = (^z-i nx,),o, ^^ 


4.3 


^^ =^(^z-l ' ^^) 


; e a variavel de junta se for rotacional 


4.4 


a- — A z- . , z- 


^^ 






Next i 



Tabela 4.2 - Algoritmo de Denavit-Hartenberg para um manipulador com n juntas 

4.3.3 Representagao de Denavit-Hartenberg para um PUMA de 6 DOF 

Um exemplo interessante de obtengao de sistemas de coordenadas por ser visto na Figura 4.18. Trata- 
se de um manipulador do tipo PUMA com 6 graus de liberdade, que e um robot com grande expressao 
pratica a nivel industrial. O exemplo pode parecer algo elaborado mas, sendo um exemplo extraido da 
bibliografia, e relevante que se fagam todavia algumas observagoes em relagao ao representado. 

• O sistema de eixos (xo, yo, zo) poderia ter sido colocado na base. Isso alteraria apenas um dos 
parametros cinematicos do primeiro elo (translagao em z) 

• Os eixos xo e yo poderiam estar rodados +90° em torno de zo. Essa e tambem uma variante comum. 

• Os eixos zi, Z2 e Z4 poderiam apontar no sentido oposto, que teria como consequencia sentidos 
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opostos para yi, y2 e y4. A principal diferenga das duas alternativas seria o sentido de rotagao 
positiva para os angulos de junta para o observador, mas de resto nao haveria alteragoes que 
afectassem a resolugao do sistema. 

O manipulador nao esta representado na sua posigao zero! Para isso os elos deveriam estar 
orientados de tal forma que todos os eixos xi fossem paralelos. Nao estando na posigao zero dever- 
se-a ter algum cuidado na determinagao dos diversos angulos de junta ja que alguns terao termos 
constantes adicionais de +90°, mormente 61 e 63. 




Junta / 


e. 


a, 


1 


90° 


-90° 


2 








3 


90° 


90° 


4 





90° 


5 





-90° 


6 









Figura 4.18 - Exemplo de sistemas de coordenadas para um PUMA de 6 DOF e indicagao de e a na configuragao 

ilustrada 

4.4 Exemplos de construgao da Cinematica Directa 

De seguida apresentam-se dois exemplos de implementagao da cinematica directa de dois 
manipuladores usando o algoritmo de Denavit-Hartenberg- um manipulador antropomorfico de 5 DOF e um 
SCARA a 4 DOF. 

4.4.1 Um manipulador a 5 DOF (Microbot Alpha II) 

Aplicando o algoritmo de Denavit-Hartenberg e possivel chegar a solugao ilustrada na Figura 4.19 
para os sistemas de coordenadas de um manipulador do tipo Microbot Alpha II. 
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Lb Lc Ld 

l< >\< >K — H 

4 



L 



A 



(# # (4 X - 




Elo 


e 


a 


1 


d 


1 


Bi 


+90° 





La 


2 


62 





Lb 





3 


63 





Lc 





4 


04+90° 


+90° 








5 


Bs 








Ld 



Figura 4.19 - Sistemas de coordenadas para um manipulador antropomorfico a 5 DOF 

As origens O3 e O4 coincidem, pois que O4 e dado pela intersecgao de Z4 com Z3. Note-se tambem que o 
robot nao esta na posigao zero e, por isso, a junta 4 tern na definigao da sua variavel o termo correctivo de 
+90°, ou seja, nesta posigao inicial, na qual os angulos de junta assumem o valor zero, o eixo X4 ja esta 
"adiantado" 90"" em relagao a xg. 

Na sequencia do algoritmo da cinematica directa basta obter as matrizes de transformagao associadas 
a cada elo, usando a expressao (4.1), e pos-multiplica-las em sequencia. Para a primeira matriz vem^ 



Ai = 



C^ -S^C (90) S^Sim 0-C^ 
S^ C^Cim -C^S{90) 0-S^ 








6'(90) 




C(90) 




L. 



C^ s^ 
S^ -q 



1 














Para as matrizes seguintes, tambem e imediato chegar as suas expressoes^ 



A2 = 



















^B ' ^2 






1 


^B ' ^2 




A — 





1 





Cg -6'3 
















^c ' ^3 





^c ' ^3 


1 








1 



A, = 



C{0^ +90) S{0^ +90) 

S{0^ +90) -C{0^ +90) 

10 





1 



■^4 





c. 












1 









'^5 = 











1 










-^5 








c, 











1 


Ln 








1 



A expressao final da transformagao geometrica do referencial da base para o referencial da mao 
obtem-se pela seguinte multiplicagao^ 
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Rrp _ 



c. 





^1 


s. 





-c 





1 




















Lyr) Or) U -L/n • Lyr) 

Or, Lyr, U -L/tj • Or, 








1 







1 



Cg -^'3 L^ • C^ 



S^ Cg 



L,.S, 








1 







1 






1 

Repartindo o produto em dois termos fundamentais, (AiA2A3)(A4A5), vira- 

I/^ ('^2^3 + ^2*^3 ) + ^B^2 + ^.1 



-^4 





^4 


0] 


c. 





^4 








1 

















ij 



C5 -^5 



^5 C, 









1 L 



D 

1 



S^C^ + ^2*^3 



-S^S^ + c^c^ 






^4^5 ^4 ^D^4 



1 

Ou, recorrendo a relagoes trigonometricas, numa forma mais simplificada- 
















Rrj, _ ^ 

H -2 



^1-2-3 + ^123 *^l-2-3 *^123 ^^^ L^ (^1-2-3 + ^123 ) + '^^B^1^2 

'^123 + *^l-2-3 ^123 ~ ^1-2-3 "^^1 ^C (*^123 + *^l-2-3 ) + '^^B^1^2 



2S, 



23 



2a 



23 











2 



-^^Cg ^^^g 











c. 


LjjC^ 


s. 


LjjC^ 











1 



(4.4) 



Recorde-se que Ci-2-3 = 008(61-62-63) e C123 = 003(61+62+63), etc. O resultado final, por extenso, tem 
uma representagao com uma dimensao grafica muito grande e praticamente sem interesse neste momento. 
O recurso a meios numerico-computacionais e, por isso, recomendado para a obtengao de valores concretos. 

Para efeitos de verificagao admitamos, por exemplo, que todas as juntas tem valor 0, ou seja, a 
representagao ilustrada na Figura 4.19. Assim, por substituigao directa na expressao anterior teriamos- 



T = 



1 








L^ + 








-1 








1 

















1 



^B 









1 


Ld' 




1 








^D 







1 








— 











1 





1 
0-10 

1 




^5 + ^C + ^D 



L. 



1 



Desta expressao sai que a origem do sistema de coordenadas da mao esta em (Lb+Lc+Ld, 0, La), que 
X4 aponta na direcgao de zo, y4 aponta na direcgao simetrica de yo, e Z4 aponta na direcgao de xo, o que se 
confirma observando a Figura 4.19. 

4.4.2 Urn manipulador do tipo SCARA (4 DOF) 

Um manipulador muito usado na pratica e o SCARA de 4 graus de liberdade, de que se ilustra uma 
representagao na Figura 4.20. As 4 juntas foram numeradas obedecendo a sua ordem de aparecimento a 
partir da base. Podem surgir duvidas, na junta 3, se, na verdade, a ordem e a representada. Esta 
representagao assume que a junta rotacional do punho esta apos a junta prismatica, e que e de facto o caso 
mais comum. Porem, tambem se poderia ter o caso que a junta rotacional estivesse "antes" da prismatica, 
implicando um sistema mecanico diverso que realmente suportasse a junta linear "sobre" um elo que poderia 
rodar em torno de si proprio. Nesse caso a ordem das juntas seria a inversa da indicada e tambem os 
parametros cinematicos seriam outros, mas o resultado final seria o mesmo. 
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Elo 


e 


a 


1 


d 


1 


Bi 


+180° 


Lb 


La 


2 


02 





Lc 





3 











ds 


4 


64 








Ld 



-A 



^^1 



Lr 



yi> 



Zl 



f02 y^^ 


,Z2 




y3>^ 


yZs y 


m 


Iz4 M -^- 



xo 

Figura 4.20 - Sistemas de coordenadas e parametros cinematicos para um SCARA de 4 DOF 

Note-se que na representagao o manipulador nao esta na posigao zero. Em especial e notorio a junta 
prismatica que, para melhor visualizagao, esta estendida apresentando, por isso, um valor de junta nao nulo. 

A metodologia seguida e similar a do manipulador anterior e, assim, a determinagao das matrizes de 
transformagao e tambem muito sistematica. Vira portanto^ 

'C^ -^^^(ISO) V(180) L^CA \C^ S^ L^C^ 
S^ Cf{\m) -^^5(180) L^S^ S^ -C^ L^S^ 



Ai = 








5(180) 




(7(180) 




La 
1 



A2 = 



C2 -^'2 L^C^ 



Oo v^o 



L^S, 













1 







1 



A3 = 



1 














1 














1 


^3 











1 



c, s. 





Si - 


^1 











-1 













\c. 


-^4 


A 


s. 


c. 


A4 - 

















La 
1 















1 


Ln 





1 



A matriz final, resultante dos quatro produtos, apos simplificagoes de indole trigonometrica, e dada 
pela expressao seguinte, onde se convenciona ainda que C1-2 =003(61-62), Ci-2-4 = 003(61-62-64), etc.- 



R 



T = 



^1-2-4 


"^1-2-4 





L^C^ + ^c^i-2 


"^1-2-4 


~^l-2-4 





L^S^ + Lc^i-2 








-1 


^A ~ ^3 ~ ^D 











1 



(4.5) 



Mais uma vez se pode confirmar a sua validade para o caso das juntas terem todas o valor e, neste 
caso, ate mesmo para outros valores, dada a relativa simplicidade do manipulador quando comparado com o 
Microbot Alpha II, apresentado anteriormente. Assim, pelo menos no que respeita a componente de 
translagao cartesiana (x, y, z), pode-se constatar a veracidade da expressao anterior observando a Figura 
4.21 onde se ilustra esquematicamente uma vista de cima do manipulador; note-se porem que desta figura 
nao se podem tirar conclusoes relativamente a coordenada z. 
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Figura 4.21 - Vista esquematica de cima do manipulador SCARA 

4.5 Angulos finals de orientagao em fungao das variaveis de junta 

Para completar o algoritmo da cinematica directa delineado na secgao 4.1.3 falta ainda o seu ultimo 
ponto, que e determinar os angulos de orientagao final do sistema de coordenadas na mao, ou, se se preferir, 
OS angulos de Euler. Como visto num capitulo anterior, existem diversos tipos de angulos de Euler sendo 
dois deles mais comuns, dos quais se escolhe o caso RPY para ilustrar esta parte final do algoritmo. Note-se 
todavia que o procedimento seria estritamente o mesmo para qualquer outro tipo de angulos de orientagao 
(Euler) porque nos baseamos afinal na matriz de transformagao associada. O problema que esta aqui em 
causa e o de determinar os angulos de Euler a partir dos elementos da matriz de transformagao do 
manipulador. 

4.5.1 Comparagao da matriz RPY((|),9,\|/) coma parte rotacional da matriz ^Th 



A expressao generica de transformagao global no espago a 6 dimensoes, usando angulos RPY, e dada 



por^ 



R 



Th = 



transformagao 
de translagdo 



= Trans{p^,Py,p,)RPY{(j),0,ilj) = 



transformagao 
de orientagdo 
— Trans [prj.,Py,p^)Rot{z,(j))Rot{y,0) Rot (x^ip) — (4.6) 

C(l)CO -S(l)Ctlj + CcpSOSt/j S(t)Sij + C(t)SOCij p^ 
S(t)CO C(t)Cij + S(t)SOSij -C(t)S^lj + S(t)SOCij py 

-se cosip coctp p, 

1 

A matriz de transformagao do manipulador resulta do produto das transformagoes intermedias dos N 
elos e pode ser expressa do seguinte modo- 



R 



T — A A A — 



^x 


Sx 


a^ 


Px' 




Uy 


Sy 


ay 


Py 




n. 


Sz 


a. 


Pz 













1 





n s a p 

1 



Se o vector p tem um significado de imediato entendimento (coordenadas da origem do sistema da 
mao medidas no sistema de origem), o mesmo nao se aplica aos tres vectores individualizados na expressao 
anterior, n , s , a , e que estao associados a orientagao do sistema de eixos da mao em relagao ao sistema de 
referenda de base. 

Para se entender melhor o significado destes tres vectores fazem-se as atribuigoes ilustradas na 
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Figura 4.22. O vector a e designado por vector aproximagao da mao, e tern uma direcgao que e normal a 
palma da mao; o vector s e designado vector escorregamento ou deslizamento da mao {sliding) e tem a 
direcgao do movimento dos "dedos"; o vector n , finalmente, completa o sistema directo de coordenadas, e e 
designado por vector normal aos "dedos" da mao. 

S 




Figura 4.22 - Orientagao do sistema de coordenadas da mao 

Assim, por simples comparagao das expressoes indicadas anteriormente, pode-se escrever, por 
exemplo, o seguinte^ 



n^ — —sin 6^ 
s^ = cos ^ sin '0 
n„ = sin 6 cos 



6 — arcsin ( —n^ ) 

^j) — arcsin ( s^ j cos Q ) 

= arcsin ( n^ / cos d ) 



(4.7) 



Ficam assim determinados os angulos de Euler com base na matriz de transformagao do manipulador 
como se pretendia. Adiante-se desde ja que esta nao e uma boa solugao do ponto de vista numerico, como se 
explica na proxima secgao. 

4.5.2 Limitagoes de precisao e reformulagao 

Na secgao anterior, nomeadamente na ultima expressao dos angulos de Euler, nota-se porem que, 
quando o angulo 6 tendo para 90°, o co-seno de 6 tende para 0, e algumas das expressoes correm o risco de 
perder precisao em calculo numerico. Uma hipotese alternativa e utilizar mais igualdades extraidas das 
duas matrizes e usa-las aos pares de forma a minimizar esse risco de imprecisao numerica. Poderemos entao 
ter as seguintes igualdades^ 



n^ — — sin^ 

s^ — cos ^ sin '0 e 

a^ — cos cos ijj 



rirj. — cos cos ^ 
Uy — sin (j) COS 



n„ 



— arcsin ( —n^ ) , ^ — tan ^jj , ^- — tan 



n^ 



A fungao tangente inversa (arco-tangente) afigura-se menos sensivel as imprecisoes dos termos da 
matriz de transformagao do manipulador, quer porque eventuais erros sistematicos nos termos se atenuam 
na divisao {sjaz, etc.), quer porque o dominio da fungao arco-tangente e infinito e portanto sem risco de 
indefinigao. 

Porem, a obtengao dos angulos com recuso a fungao arco-tangente apresenta um outro problema 
ligado a determinagao do quadrante do angulo em causa. Por exemplo, se az= Sz= -1 entao o quociente sJaz 
resultaria igual ale portanto ^= 45°. Or a, ao ponto (-1,-1) corresponde um raio- vector com o angulo de - 
135°. Este erro de 180° representa o proprio periodo da fungao tangente e tem de ser levado em conta no 
calculo. Assim, uma aplicagao "cega" da fungao arco-tangente podera ser incorrecta; e por isso que se deve 
atender ao quadrante do "ponto" antes de calcular a arco-tangente. Muitas aplicagoes de "software" 
numerico recorrem a fungao arco-tangente com dois argumentos em vez de um s6\ existe a vantagem 
adicional de poder lidar de antemao com quocientes onde o divisor seria 0. Nomes como atan(y,x) ou 
atan2(y,x) sao muito comuns para esta fungao. A Tabela 4.3 define a fungao atan2(x,y), tal como e 
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implementada na grande maioria das aplicagoes de "software". 



CondiQao 


DefiniQao 


Quadrantes 


x>0 


V 
arctan — 

X 


re 4° 


x=0 Ay ^0 


sign(y)-- 


Eixo das ordenadas 


x<0 


arctan — h sign (y) • tt 

X 


2°e3° 


x=OAy=0 


Nao se define, mas o valor e por vezes atribuldo 



Tabela 4.3 - Definigao da fungao atan2(y,x) 

Para alguns manipuladores, ou algumas configuragoes especificas, as expressoes extraidas das 
matrizes de transformagao, pelas variaveis e termos que incluem, nao se proporcionam ao uso directo da 
fungao arco-tangente. Nesses casos, podera o problema ser reformulado usando uma tecnica relativamente 
simples' a de reorganizar a equagao matricial por pre- ou pos-multiplicagao de transformagoes parciais, ou 
seja, passar, por exemplo, da formula^ 

^Tjj = Trans(^Px,Py,Pz)Rot{z,4>)Rot(y,0)Rot{x,ip) 

a formula- 

Rot~^ {z,(j))Trans~^ [prj.,Py,Pz) T^ — Rot(y,0)Rot(x,ilj) 

Usando propriedades apresentadas anteriormente, podemos obter as expressoes das matrizes 
inversas de uma forma muito imediata- 

"C0 -S(i) or^ 

Sep C(t) 
10 
1 



Ror\z,(l)) = 



C(t) S(t) 

-Scj) C0 

10 

1 



Trans ^{Px^Py.Pz) = 



10 


Px' 


-1 


10 


-Px' 


1 


Py 




1 


-Py 


1 


Pz 




1 


-Pz 















O que resulta em- 

' Ccj) 50 -p^ 

-Set) Ccj) -Py 

1 -p, 

1 



n^ 



n,, 



n^ 







'^Z 









Px 

Py 

Pz 

1 



CO ^ se ^ 

10 

-se C(9 

1 



10 

Ci) -Si) 

^v^ cv^ 

1 



e finalmente- 

'nr^CcJ) -\- UyScJ) Sr^CcJ) -\- SyScJ) tt rj.C (J) ^ tt y S (J) ^ 

UyCcj) — UxScj) SyCcj) — s^Scj) arj.C(j) — ayScj) 



Uy 







"^z 





a 



ce sesi) sec^j o 

C^j -S^j 

-se cesi) cec^i) o 

1 



(4.8) 



Podemos agora repetir o processo ja levado a cabo anteriormente (comparar as matrizes termo a 
termo) e extrair mais alguns resultados. Assim, poderemos obter sucessivamente os angulos (j), 6e y/- 
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para (p'- riyCcj) — riy-Scj) = ^> = arctan- 



n,, 



para 6'- 



para y/'- 



n^Ccj) + UyScj) = CO 
n, = -SO 



n^ 



— arctan 



—n^ 



Urj-Ccj) + UyScj) 



s^ = COSi/j ^ 

nnn I ^ ^ = arctan^ 



Note-se porem que ha outras expressoes que poderiam ser usadas. O que ficou assim garantido foi o 
recurso exclusive da fungao arco-tangente em detrimento de arco-seno ou arco-co-seno. Nas expressoes 
acima, onde se le arctan, assume-se atan2, na definigao dada. 

4.5.3 Exemplo de aplicagao a um manipulador com 2 DOF em 3 dimensoes. 

A matriz de transformagao para o manipulador descrito na Figura 4.17, como derivado na ocasiao, e 
dada por^ 



R 



T = 



C^C^ 


-C^S^ 


^1 


L^C^C^ 




"% 


Sx 


a^ 


Px 


s^c^ 


-S^S^ 


-c. 


L^S^C^ 




Uy 


Sy 


ay 


Py 


^2 


^2 





L^S^ + A 




n^ 


Sz 


a^ 


Pz 











1 













1 




Assim, para esse manipulador, determinem-se os seus angulos de Euler, isto e, a sua orientagao no 
espago cartesiano relativamente ao referencial da base. Aplicando os resultados da secgao anterior 
poderemos obter, por simples substituigao, o seguinte- 

^x 



= arctan ^- 



= arctan = arctan ( tan ^^ j = 0-^ 



C^C^ 



— arctan 



— n^ 



%(70 + UyScj) 



— arctan 



-S^ 



C-^C^C^ + *^i^2*^i 



= arctan 






lb = arctan ^^ih = arctan (Cr,,0) = — (ou -n/2 se | 9 | > n/2) 
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Cinematica In versa de 
Ma nip ula dores 



Z3 = y4= X5 




n s [aj ^ 
1 



^R. 



L^ W (A,A,A3 



^ m m p 
0001 



^^R. = 



1,3 Xlg 



P^ = P - d,^ 



Hg S3 Bg 



(A^A^Ag 
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5. Cinematica Inversa 



5.1 O Problema 

Enquanto a cinematica directa resulta do desenvolvimento imediato das expressoes do manipulador, 
a cinematica inversa procura determinar o conjunto de valores das juntas que se adequam a uma dada 
configuragao do espago operacional ou cartesiano. A cinematica inversa pode ser vista conceptualmente como 
o conjunto de processos para determinar as fungoes inversas do sistema das expressoes da cinematica 
directa. Ou simbolicamente- r = F(q), q = F"^(r), F"^ : 91" h^ 91^ . Graficamente o problema entende-se 

pela observagao da ja anteriormente introduzida Figura 5.1. 







k. 


Cinematica 
directa 










w 
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Espago das 
juntas (q) 




Espago 
cartesiano (r) 


ik 
















Cinematica 
inversa 


.M 








"4 







Figura 5.1 - As cinematica directa e inversa e a relagao dos espagos 

A cinematica inversa nem sempre e um problema com solugao analitica, ou por vezes nao tem mesmo 
solugao! Mais complexo ainda e o facto de nao haver uma metodologia unica de aplicagao directa. Nao sera 
esse um problema grave porque as solugoes de interesse pratico estao ja todas bem estudadas e so em casos 
especiais sera necessario conceber novas solugoes. 

5.1.1 Resolugao para um manipulador RR no piano 

Dos manipuladores com interesse pratico o caso mais simples e o do manipulador planar a dois graus 
de liberdade (2-DOF). Ilustra-se de seguida o processo de determinar a sua cinematica inversa, quer dizer, o 
valor das suas juntas 6i e 62 em fungao da posigao (x,y) da sua extremidade. 




Figura 5.2 - Manipulador planar a dois DOF 

Partindo das equagoes da cinematica directa, que sao de facil formulagao, e que foram anteriormente 
deduzidas, o processo e o seguinte^ 
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(5.1) 



X = L^ cos 0^ + L^ cos ( ^^ + ^2 ) 
y — L^ sin 0^ + 7^2 sin [0^ + ^2 ) 
Elevando ambos os membros das duas expressoes ao quadrado, e adicionando-os, ficara- 

x^ + ^2 ^ L^ cos^ e^ + L^ sin^ 0^ + 

+4 sin^ [6^ + ^2 ) + 4 cos^ (6^1 + ^2 ) + 
+2L^L^ cos 6>-L cos ( 6>^ + ^2 ) + ^ A^2 ^^^ ^1 ^^^ ( ^1 + ^2 ) 
Vira entao sucessivamente- 
x^ + y^ = l}^ + l}^ + 2L^L^ [cos^^ (cos^^ cos ^2 ~ sin^^ sin ^2 ) + sin^^ (sin^^ cos ^2 + sin ^2 cos^^ )] 

x^ + ?/2 = -^1 + 4 + 2I'^i^2 (cos^ 0^ cos ^2 ~ cos^^ sin^^ sin ^2 + sin^ 0-^ cos ^2 + sin^^ sin ^2 cos^^ ) 

x^ + y'^ = L\+ L\+ 2L^L^ cos 6^ 



62 — iarccos 



x^ + y^-n- n 



2L^L^ 



(5.2) 



Pode verificar-se desde ja a existencia matematica de duas solugoes para 62. reforgada pelo sinal + na 
expressao (5.2). 

A obtengao de 61 nao e tao imediata e uma solugao possivel passa pelo recurso a tangente 
trigonometrica de uma diferenga angular, como se pode observar de seguida- 




td.Ti{A- B) = 



tan/3 = 



tan A — tan B 
1 + tan A tan B 

Lo sin 0^ 



L^ + L^ cos ^2 



tana = — 

X 

Figura 5.3 - Angulos auxiliares para determinagao da 
cinematica inversa do manipulador RR 

Na Figura 5.3, como 0-^ — a — [3 , vira, pela relagao da tangente da diferenga, o seguinte^ 

y 



L^ sin ^2 



tan ( a — /? ) = tan ( ^^ ) = 



X 



L^ + L^ cos ^2 y{-^i~^-^2 ^^^ ^2) ~ ^^2 ^^^ ^2 



1 + 



y ^2 sin ^2 x{L^ + L^cosO^) + yL^s'mO^ 

X L-^ + ^2 *^^^ ^2 



ou seja 



0-^ — arctan 



y[L-^ + -^2 ^^^ ^2 ) ~ ^^2 ^^^ ^2 
X ( L^ +7^2 cos ^2 ) + ?/^2 ^^^ ^2 



(5.3) 



5.1.2 Resolugao para o manipulador RR a 3D 

E tambem possivel resolver a cinematica inversa de um outro manipulador ja introduzido 
anteriormente no estudo da cinematica directa. Trata-se do sistema RR no espago a 3D que se ilustra na 
Figura 5.4 e onde tambem se apresenta a expressao da cinematica directa conforme derivado anteriormente. 
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igualada a matriz de transformagao geral que indica a postura no espago operacional com posigao e 
orientagoes. 




Rr 



"■H 



C^C^ 


-C^S^ 


^1 


L^C^C^ 




■% 


^x 


a^ 


Px 


s^c^ 


-S^S^ 


-c. 


L^S^C^ 




Uy 


Sy 


ay 


Py 


S2 


c. 





L^S^ + A 




n^ 


Sy 


ay 


Pz 











1 













1 



Figura 5.4-0 manipulador RR no espago 3D 

Mesmo restringindo-se ao uso de componentes de posigao na matriz de transformagao geral (por 
serem em geral mais faceis ou explicitas de obter na pratica), a resolugao e imediata para a variavel 9i apos 
a divisao entre dos termos respeitantes a posigao px e py^ 

L^C^C^ — Px 



Py 



-^ tan 0^ — — ^^ ^1 = arctan 

L^b^C^ — Py Px Px 



(5.4) 



A obtengao de 62 pode ser imediata se se considerarem as componentes de orientagao, bastando 
atender a nz e Sz e a arco-tangente do seu quociente mas, com base no termo pz da posigao, viria tambem: 



0^ — arcsm 



(5.5) 



A expressao (5.5) pode todavia apresentar limitagoes de precisao numerica quando o valor de pz-Li for 
muito proximo de L2 ou mesmo se tiver erros sistematicos na sua avaliagao, isto e, nao se esta a usar uma 
fungao de arco-tangente com os seus beneficios numericos como descrito anteriormente noutro capitulo. Mais 
tarde apresenta-se outra solugao para este manipulador em que esse problema se resolve. 

5.1.3 Metodos e condigoes de existencia de solugoes. 

A resolugao analitica apresentada para o caso RR planar ou o RR no espago nem sempre pode ser 
facilmente estendida a mais graus de liberdade ou dimensoes. Existem varios metodos alternativos na 
literatura dos quais se destacam os seguintes- 

• Transformagoes inversas (Paul et al., 1981) 

• Matrizes duals (Denavit, 1956) 

• Quaternions duals (Young & Freudenstein, 1964) 

• Metodos iterativos (Vicker et al., 1964) 

• Abordagens geometricas (Lee & Ziegler, 1984) 

Em qualquer dos metodos ha porem varias condigoes e situagoes para a existencia de solugoes, e das 
quais se destacam as seguintes^ 

• O ponto no espago operacional deve estar no espago de trabalho 

• Nao se deve exceder os limites fisicos das juntas 

• Para haver solugao analitica (num caso de 6 eixos) e suficiente que 3 eixos de juntas sucessivas se 
intersectem ou sejam paralelos (Solugao de Pieper) 

5.1.4 A redundancia cinematica 

Quando um manipulador pode atingir uma dada posigao no espago com mais de que uma configuragao 
das juntas, diz-se que ha redundancia. Diz-se que uma redundancia e uma posigao alternativa devido a uma 
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junta, e se for N o numero de redundancias entao o numero de solugoes e dado por 2^. Se o numero de 
solugoes for maior que o numero de juntas entao a resolugao da cinematica inversa do manipulador pode 
trazer dificuldades adicionais, como a impossibilidade de obter uma solugao. No exemplo anterior do 
manipulador RR planar as solugoes matematicas sao de facil interpretagao graficamente, como ilustra a 
Figura 5.5. 



(x,y) 




Figura 5.5 - Redundancia no robot RR planar 

Matematicamente a existencia de redundancia detecta-se normalmente pelo aparecimento da fungao 
arccos(x) ou de radiciagao (Vx). 

A situagao de redundancia pode ocorrer quando ha mais graus de mobilidade do que os necessarios. 
Manipuladores com mais de seis graus de liber dade sao ditos infinitamente redundantes. Na Figura 5.6 
ilustram-se as 4 solugoes classicas de um manipulador antropomorfico (cotovelo-em-cima ou cotovelo-em- 
baixo, ombro-a-direita ou ombro-a-esquerda) 







Cotoveloemcima 
ombro a esquerda 



Cotoveloemcima 
ombro a direita 



Cotoveloembaixo 
ombro a esquerda 



Cotoveloembaixo 
ombro a direita 



Figura 5.6 - As quatro solugoes de um manipulador antropomorfico usando so as juntas primarias 

Quando o manipulador tem um numero infinito de configuragoes para uma dada posigao da mao diz- 
se que se atingiu uma situagao de degeneragao. Casos mais comuns sao o do manipulador RR planar de elos 
iguais para a mao no ponto (0,0), ou ainda numa situagao em que o punho do robot fique com dois eixos 
colineares e alinhados (Figura 5.7). 




^ 



66 



M ^\ 






Figura 5.7 - Ilustragao de duas situagoes de degeneragao^ ha um numero infinito de combinagoes de (01,62) ou (94,96), 

respectivamente, para o end-effector nSiS configuragoes indicadas. 
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5.2 Algoritmo para uma Heuristica de Cinematica Inversa 

Dadas as dificuldades para a obtengao da cinematica inversa para um caso geral, o que se propoe 
usualmente e o de seguir um conjunto de regras de forma a obter uma dada heuristica (descoberta) em que 
OS pontos principais sao os seguintes- 

1- Equacionar a matriz de transformagao geral e a matriz de transformagao do manipulador 

2- Procurar em ambas as matrizes- 

— Elementos que envolvam um so variavel de junta 

— Pares de elementos que, quando divididos, produzem uma so expressao numa variavel de 
junta (e que se possa usar a fungao atan2 de preferencia) 

— Elementos ou suas combinagoes simplificaveis trigonometricamente 

3- Equacionar elementos nas duas expressoes 

4- Repetir o processo para todos os termos identificados em 2 



Compara a expressao de transformagao geometrica do manipulador (A1 A2...An) com a 
expressao de transformagao geral 



Procurar elementos 
a) que envolvam uma so variavel 
bjpares de elementos divisiveis que resultem numa expressao a uma variavel 

(que possa usar a fungao atan2() de preferencia) 
c) elementos ou combinagoes de elementos simplificaveis trigonometricamente 



Resolver todas as equagoes identificadas no passo anterior 



Tentar usar as componentes do vector de translagao (p) mesmo 
que nao tenha variaveis isoladas 




Nao 



Pre-multiplicar a equagao matricial pela inversa de A1 

ou 

Pos-multiplicar a equagao matricial pela inversa deAn 

e repetir esse processo para as restantes Ai ate se esgotarem 



Firm 



Nao 




simi 




Solugoes 
imprecisas 




Firm 



Recorrer as solugoes 

imprecisas rejeitadas 

anteriormente... 



3e ainda houver variaveis de junta por resolver\ 

e provavel que seja fisicamente impossivel 

chegar a solugao para o manipulador 

em causa 



...edefiniras zonas de 
funcionamento sem risco. 



Figura 5.8- Algoritmo para uma heuristica de cinematica inversa 
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Nem sempre os passos apresentados sao suficientes ou mesmo os ideais para obter as expressoes para 
todas as variaveis de junta. Nesses casos e necessario recorrer a alguns artificios de manipulagao de 
expressoes como o recurso a pre-multiplicagao pela inversa de uma componente do produto A1A2...AN. Na 
Figura 5.8 apresenta-se um algoritmo com os passos para um procedimento mais completo visando a 
obtengao das expressoes para todas as variaveis de junta de um manipulador. 

5.3 Recurso a transformagoes inversas e comparagao dos elementos matriciais 

Uma das tecnicas possiveis para chegar a expressoes de cinematica inversa, inclusive no ambito do 

algoritmo generico delineado na Figura 5.8, e o de recorrer as transformagoes inversas com o objectivo de 

obter expressoes mais facilmente soluveis. Ou seja, partindo da expressao matricial da cinematica do 
manipulador ^T^ =A^A2...A^, que leva ao conjunto de equagoes da cinematica nas variaveis e 

parametros de juntas, elos e espago operacional, reorganiza-la com a expectativa de obter expressoes 
individuals mais interessantes. Isto equivale a dizer que uma primeira reorganizagao seria 

T^ -A" = A-,^A2...A^_-,^ , ou em seguida T^ -A" ■ A~_-^ = A-,^A2...A^_2 ' ^ assim por diante 

enquanto possivel ou favoravel, ou respectivamente por pre-multiplicagao, isto e, passar para 
Af • T/7 = A2...A^ e sucessivamente. 

Exemplifique-se o processo pre-multiplicagao pelas inversas com o manipulador RR no espago a 3D 
descrito anteriormente (Figura 5.4), relembrando de um capitulo anterior as matrizes dos dois elos- 



±2 — A-,^ • A2 — 



C^ s^ 

s. -a 



1 






























^2^2 







^2*^2 




1 





— 





1 





^1^2 



-C^S^ 



s^c^ s^s^ 











^1 






1 



Neste caso, vai-se recorrer a pre-multiplicagao, ou seja, obter-se-a- A^ ^ 
desenvolvida, vira sucessivamente ^ 



^T2 = A2 , ou, de forma 



A-i . 0T2 = A2 ^ 



C^ S^ 

s. -a 



Ci 


^1 











1 


^1 


-Ci 















1 




-A 



1 






Uy 






-1 







k 




1 















n 


s 


a 


P 













1 





Or, Oo 
















A ^2 





k^2 


1 








1 



(5.6) 



^X 


^x 


Px' 




Sy 


ay 


Py 




Sz 


a^ 


Pz 










1 





C2 

S2 






— 02 L2C2 

C2 L2S2 

1 

1 



n, s, a, Pz - h 

rixSl — UyCl Srj-Sl — SySl tt rj-S I " tt^^l P^Sl " P yC I 

1 



^2 ~^2 L2C2 

02 62 L202 

10 

1 



(5.7) 



Tentando recorrer apenas a termos de posigao (pelas vantagens ja referidas), vira o seguinte par de 
expressoes. 

'PxCi + PyS^ = L^C^ 

T - T ^ (5.8) 

Pz ~ ^l — ^2*^2 

do qual se obtem imediatamente a expressao para 62 admitindo que ja se tinha obtido 61, por exemplo. 
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usando (5.4)' 

p^ — L-. 
Or, = arctan — — -^ (5.9) 

A vantagem imediata da expressao (5.9) em relagao a expressao (5.5) e que se usa uma fungao arco- 
tangente; realga-se portanto que esta tecnica das matrizes inversas pode oferecer a possibilidade de solugoes 
alternativas, e por vezes ate as unicas possiveis. 

5.4 Solugao de uma equagao usual no problema da cinematica inversa 

Da expressao (5.7), entre outras, verifica-se que existe um tipo de equagao trigonometrica que surge 
com relativa frequencia na determinagao de cinematica inversa, e que se traduz genericamente da seguinte 
forma- 

k-^ cosO + k^ sinO — k^ (5.10) 

E por isso importante que se derive uma solugao generica expedita, o que se faz de seguida. Seja 

, ^ . .0 1-cosO oO l + cos6> 
K = tan — ; sabendo que sm — = e que cos — = e, portanto, que 

Zi Zi Zi Zi Zi 

^ oO 1-cosO ,2 . • 1- .. ^~^^ 1 1 . . • ~ 

tan — = = k , e imediato provar que cos U — ^ , bastando usar mera substituigao para o 

2 1 + cos ^ 1 + A; 

1 — cos 

1 + cos 6> 1 + cos ^ - 1 + cos 2 cos ^ . 

veriricar- — = = cos 6 . 

1 - cos 6> 1 + cos 6> + 1 - cos 6> 2 

1 + cos 6> 

2k 
De forma similar se prova que sin 6 — ^ , mais uma vez recorrendo a simples substituigao^ 



^ jl-cosO ^^^ , „, /l-cos6> 

2 tan- 2 J- 2(1 + cos 6>) 



2 _ Vl + cos^ _ ^ ^^"^^^Vl + cos^^(^^^^^,^/l-cos^ 



1 - COS 6^ 1 - cos 6* 1 + cos ^ + 1 - cos ^ V 1 + cos ^ 

1 + cos 1 + cos 

/(l + COS^)2(l-COS^) r 2- . ^ 

= J- ^ = Vl - cos"^ ^ smO 

V 1 + cos 6> 

Assim, apos a substituigao destes termos em irna expressao original (5.10) vira sucessivamente^ 

k^{l-k^) + 2k^k = k^{l + k^) 

{k-^ +k^)k'^ -2k^k + {k^ - A; J = 



k = 



= 2- arctan 



''3 



fCi ~r '^'o 



fCi ~r rvo 



(5.11) 



5.5 Algumas solugoes analiticas padrao 

A maioria dos manipuladores industrials pertencem a um pequeno numero de tipos e configuragoes 
cinematicas, e obedecendo a umas regras tais que e relativamente expedito obter a solugao da sua 
cinematica inversa. De seguida apresentam-se algumas solugoes para manipuladores mais simples que 
podem ser combinadas, ou usadas na determinagao de solugoes de manipuladores mais complexos com 6 
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graus de liberdade, por exemplo. Alem das apresentadas, outras solugoes mais especiais podem ser 
encontradas na literatura indicada na bibliografia. 

5.5.1 Robot planar de 3 elos 

A cinematica inversa de um robot planar de tres eixos determina as expressoes de [61, 62, 63] dado [x, 
y, (|)]. Se a orientagao (|) nao fosse dada entao haveria redundancia, e o brago teria um numero infinito de 
solugoes. Note-se para ja que a orientagao ^ e dada por: 

= 6>^+6>2+^3 (5.12) 




(5.13) 



Figura 5.9 - Manipulador RRR planar 

A resolugao da cinematica inversa deste robot assenta na do robot planar RR uma vez que o ponto Pw 
(Figura 5.9) e um ponto conhecido porque se sabe, obviamente, a posigao e a orientagao do end -effector hem 
como o comprimento de elo Ls^ 

Pwy = y-h^^ 

Mas, tendo em conta as expressoes geometricas (5.1) ja determinadas para o manipulador planar RR, 
pode tambem escrever-se o seguinte^ 

ou, desenvolvendo, 

^Wx ^ A^l + ^2^1^2 ~ ^2*^1*^2 

As expressoes (5.15) levam a ja conhecida solugao para 62 como visto em (5.2). 

PVx + P\y ^ L\+L\+ 2L^L^C^ 



(5.14) 



(5.15) 



(5.16) 



O2 = iarccos 



p2 I p2 7-2 7-2 

^Wx + ^Wy ~ h~ ^2 

2L^L^ 



(5.17) 



Em (5.17) mais uma vez se inscreve o sinal ± para recordar a redundancia do manipulador de 
cotovelo-para-baixo ou cotovelo-para-cima. 

Dado 62, a obtengao de 61 podera ser feita como em (5.3) para o manipulador RR ou entao por um 
outro processo (mais extenso) sem ter de recorrer a tangente da diferenga de angulos, e que se descreve de 
seguida. Basta tomar as expressoes (5.15) e resolve-las em ordem a Si e Ci, e depois fazer uma substituigao 
reciproca, como se mostra na sequencia seguinte^ 
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h + ^2^2 A + ^2^2 

Por substituigao de Si na expressao de Ci vira em sequencia- 



c^ = 






^Wrr. -\- Lr,br, 



h + ^2^2 



{L,+L,CJ 

^1 ( A + ^2^2 + 21/^1/2(72 + L^S^ ) = P^^ ( Z/^ + L^C^ ) + P^^Z/26'2 
Mas, atendendo a expressao (5.16) vira^ 

^ _ ^Vx ( A + -^2^2 ) + ^Vyh^2 
1 ~ d2 I d2 

e, apos um procedimento similar, viria para Si o seguinte^ 

^ _ ^Wy (A + -^2^2 ) ~ ^Wxh^2 

1 ~ d2 ^ ^2 

P P^x + P W^^ 

Vira finalmente para 9i a expressao (5.18), que se reconhece ser identica a (5.3)^ 

6^ — arctan — —. r 

^Wx (A + h^2 ) + ^Wyh^2 

Por fim e necessario obter 63 que resulta de imediato de- 

5.5.2 Solugao do brago antropomorfico a 3 DOF 

O brago antropomorfico a 3 graus de liberdade consta de tres juntas rotacionais num arranjo similar 
ao ilustrado na Figura 5.10, onde Pw e o ponto extremo do manipulador (onde se podera fixar um punho — 
wrisi). 

Lb 



(5.18) 



(5.19) 




Figura 5.10 - Brago antropomorfico de 3 DOF 

A expressao da cinematica directa do manipulador RRR antropomorfico pode ser derivada com base 
num resultado obtido anteriormente quando se tratou do exemplo similar ao Microbot Alpha II a 5 DOF, 
bastando considerar as tres primeiras juntas (sistemas de coordenadas de a 3). Essa expressao e dada pelo 
seguinte, onde La, Lb e Lc sao os comprimentos dos 3 elos em causa^ 
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^T. = 



S^C^ + ^2*^3 



^C (*^2^3 + ^2*^3 ) + ^B^2 + ^A 



^1^2 ^3 ~ ^1*^2*^3 "^1^2*^3 ~ ^1*^2^3 *^1 ^C (^1^2 ^3 ~ ^1*^2*^3 ) + ^B^1^2 
S-^C^C^ — S-^S^S^ —S^C^S^ — S^S^C^ -C-^ L^ 1*^1 ^2 ^3 ~ ^^1*^2*^3 ) + ^B^l^2 

-S^S^ + ^2^3 ^ 



~^1 *^1 (^C^23 + ^5^2) 

^C*^23 + ^B^2 + ^ 
1 



^1^23 

*^1^23 

*^23 







"^1*^23 

-5*^ 5*23 



a 



23 










^A 



As coordenadas de Pw sao precisamente as componentes de posigao na matriz anterior, ou seja- 

^1 (^(7^23 + ^5^2) 
*^1 (^C^23 + ^5^2) 



Pw = 



Pwx 
Pwy 
Pwz 



^C^23 + ^B^2 + ^A 



(5.20) 



Daqui sai uma expressao para 6i' 

*^l ( ^C^23 + -^5^2 ) 



PWv 



Cl ( ^cC'23 + ^5^2 ) PWx 



0^ — arctan 



P 



Wx 



PWi 



y J 



Verifica-se porem que na expressao anterior, os termos (LcC2s + ^^^^2 ) podem ser positivos ou 



negativos o que resulta no segundo caso que Oi — arctan 



-PWx 
-PWv 



— arctan 



PWx 
PWy] 



+ TT ; geometricamente 



tambem e facil verificar esta situagao. Implica isto que nesse caso 62 passa a ter o valor (71-62) e que 63 passe 

a ter o valor (-63), que se conclui igualmente pela observagao geometrica. Esta redundancia (que se tern de 

admitir tambem matematicamente pelas diversas solugoes da arco-tangente) nao implica alteragoes nas 

componentes pwx e pwy, como e obvio e, como se mostra de seguida, tambem assegura que pwz seja constante. 
Basta notar que Py^^ — L^S^^ + L^S^ -\- L^ e que os valores correspondentes das juntas 2 e 3 para esta 

redundancia nao afectam o valor de S2 nem de S23, e tornam simetricos os valores C23 e C2, bastando atender 

ao seguinte- 

sin(7r-^2) = S^ 

sin(7r-6>2 -0^) = sm{7r - {0^ +^3)) = ^^^('^2 + ^3 ) = *^23 

cos ( TT — ^2 ) — ~^2 

cos(7r-^2 -^3) = cos(7r-(6'2 +6*3)) = -C23 

Falta agora determinar a expressao para as variaveis 62 e 63 . Para isso, tomam-se os elementos da 
matriz (5.20) (nao sem antes ter re-arranjado pwz e migrar o termo La para o outro membro da equagao), e 
elevam-se ao quadrado e adicionam-se conforme a sequencia seguinte- 

pL + Pwy + {Pw. -hf = {L,C, + L,C,, f (C72 + 52 ) + {L^S, + L,S,, f 

Pwx + Pwy '^[Pwz ~ ^a) = ^B^2 + ^C^2i + '^^B^c'~^2^2i + ^B^2 + ^0^22, + '^^B^C^2^23 
Pwx + Pwy '^ \Pwz ~ ^a) = ^B + ^C + '^^B^C ('^2'^23 + '^2'S'23 ) 

Pm + Pwy +{Pw.- L^ f = 4 +Ll+ ^L,L, [C, {C,C, - S,S, ) + S, {S,C, + S,C, )] 
Pm + Ply +{Pw.- La f =Ll+Ll+ 2L,L^ {ClC, + S',C, ) 
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. ^ PW.+ Pwy + {Pwz -^a) - 4 - 4 

^3 = iarccos -— 

Para obter a expressao de 02 basta pegar nas expressoes de pwx, pwy e pwz e resolver uma delas em 
ordem a S2 ou C2, num procedimento semelhante ao do manipulador planar RRR abordado na secgao 5.5.1. 
Partindo de (5.20) obtem-se sucessivamente o seguinte: 

^PWx + PWx — ^8^2 + LcC2S = L^C2 + LcC2Cs — LcS2Ss 

Pwz - La ^ Pwx ' = ^^82 + LcC2S^ + LcC^S2 



^Pwx^ + Pwx^ + ^^^2^3 = C2 {Lb + LcC^ ) 

^PWx^ + PWx^ + LcS2S'i 



Co = 



PWx ' — ^5*^2 + ^C^3*^2 + LqS'^ 



Lb + ^c^3 

4PWx + Pw^x + LcS2S'i 



Lb + ^c^3 



^3 



Z/r'O: 



'C^3 



{Lb + LcC^)pw:, ' = ^2 (^5 + ^(7C'3 )' + \-1pwx^ +PWx^ + LCS2S: 
Recordando que ^ Pwx + Pwx — '^ vira- 

(L^ + LcCs)Pwz '- rLc^3 = ^2 [LlSi + (L^ + LcC^ f ] 

{Lb + LcC'i)pwz '- ^^c*5'3 _ (^5 + ^c^3 )Pp^2 '- ^Pwx^ + Pwy^LcS: 



S2 = 



^c*^3 + (^5 + ^c^3 ) Lc + Lb + 2LbLcCs 

Para o termo C2 vira por substituigao- 

^ _ r LcSs {Lb + LcCs)Pwz '- ^^c*5'3 



^5 + LcC^ Lb + 1/(7^3 Lc -\- Lb -\- 2LbLcC^ 
Lc^sPwz '— 



rLc^'a 



Q ^ ^ {Lb_^^J^cCs)_ ^ 

Lb + ^c^3 ^c + ^5 + '^LbLcC^ 

^ r{Ll +4 +2LbLcCs) + LcSsPwz\Lb + LqCs) - rLpS^ 
{Lb + ^cC's )(Z/c + ^5 + "^LbLcC^ ) 

Os resultados que se obtem apos a resto da manipulagao sao os seguintes- 

{Lb + ^C7^3 ){Pwz -^a)- h^?>4Pwx ^Pwy 



S2- 



a = 



Pwx + -Pp^y + \Pwz ~ ^A ) 
(4 + LcC^)^Plx+Pwy + ^C;^3 (i^P^. - ^a) 



2 — 9 

pL +P^y +(%. -^4) 



Daqui sai naturalmente 0^ = arctan — — . 

Tendo havido uma redundancia em 61 e outra em 63 o numero total de solugoes e de 2^=4. 
5.5.3 Solugao do punho esferico 

O punho esferico (3 DOF) tem os 3 eixos a intersectarem-se num ponto, e pode ser encarado como um 

subsistema de um manipulador a 6 DOF em que a matriz de transformagao resulta do produto das matrizes 
associadas aos ultimos 3 elos Tg = A^A^Ag . 
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Z3 = y4= X5 




Figura 5.11 - Os tres elos e juntas do punho esferico 

A representagao na Figura 5.11 mostra os tres eixos do punho esferico onde, apesar da junta 64 
parecer ter associado um elo com dado comprimento, e mais interessante considerar que a origem do sistema 
de eixos do punho se faz no ponto Pw ilustrado. Dessa forma poder-se-a posteriormente "concatenar" o 
manipulador antropomorfico a 3D0F com o punho esferico e assim obter um manipulador a 6 DOF. Apos 
estas consideragoes, a cinematica directa do punho esferico obtem-se com base nos parametros cinematicos 
de Denavit-Hartenberg que se ilustram na tabela seguinte- 



Elo 


e 


a 


1 


D 


4 


64+90 


+90 








5 


65+90 


+90 








6 


ee 








Ld 



Relembrando e usando a matriz de transformagao de um elo, resultam daqui as seguintes matrizes^ 



Ai = 



-54 









c. 


0" 







Sa 







1 








A5 = 








1 





e a expressao final: A4A5A6 = 



-c, 





-^5 ^5 

C, ^5 
10 
1 

O4 — ^^4^5 

C4C5 

^5 

1 



\ = 



^a ~^^a 



Oa ^a 
















Ce 






















1 


Ln 





1 















1 


Ld 





1 



A4A5A6 = 



—C4^S^Cq + 04O6 SqC4^S^ + S4CQ C/^C^ C/^C^Lj) 

1 

Comparando os termos respectivos com a matriz de transformagao geral para a orientagao: 



(5.21) 



n, 



'3?/ 



n. 



'"^z "^30 ^'iz 

obtem-se as expressoes para as diversas variaveis de junta^ 



n. 



'3x 



■^Sx Hx 



Uo 



^3y % 



a^ 



(5.22) 
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^4^5 — ^3y 



^4 = arctan- 



-(^3a 



^3, 



(5.23) 



observando que a^^ = 6*5 e que a^r^ + a^y — C^ , e portanto que 

de imediato se pode escrever o seguinte, fazendo notar que ha, por isso, duas solugoes para 05. 



^5 = arctan- 



«32 



Ainda observando e comparando (5.21) e (5.22) se deduz que- 



(5.24) 



(5.25) 



Of. = arctan ^^ 
-^3. 



(5.26) 



Finalmente deve notar-se que, dado o termo C5 ter duas solugoes, alem de 65, tambem 64 e 06 as terao 
porque tambem eles foram obtidos com base em C5. Assim, teremos as solugoes alternativas quando 
C^ — —^ja^x + ^3^ ' Q^6 recorde-se, tal com se tem vindo assumir, desde a sua introdugao, faz-se uso da 

fungao atan20 em vez da mera arctanO. 



^ '4 = arctan 



«35 



X 



0\ — arctan 



-«3t/ 
-So 



^3z 



n 



'Zz 



5.5.4 Manipuladores com um punho esferico 

Foi ja refer! do que a solugao geral da cinematica inversa de um manipulador pode tornar-se complexa 
e ate mesmo impossivel de resolver analiticamente. Todavia, uma parte consideravel dos manipuladores 
usados na pratica tem aquilo a que se chama um punho esferico, isto e, os eixos das tres juntas terminals 
(associadas fundamentalmente a orientagao) intersectam-se num ponto. Com base nos resultados observados 
no manipulador planar RRR, admite-se ser possivel definir um ponto ao longo de um manipulador cuja 
posigao pode ser expressa em fungao da orientagao e posigao do end-effector e tambem fungao de um numero 
limitado de variaveis de junta! Isto e equivalente a dizer que o problema da cinematica inversa nesses 
manipuladores e decomposto em duas partes desacopladas entre si- posigao e orientagao. 

Para o manipulador com punho esferico, a escolha natural recai sobre o ponto de intersecgao dos tres 
eixos das juntas terminals, ou seja, o ponto Pw na Figura 5.12. Como previsto anteriormente, foi a 
"concatenagao" de dois sub-componentes que deu origem a este robot; note-se todavia que o processo carece 
de um passo adicional. O sistema de eixos numero 3 e diferente no manipulador antropomorfico a 3 DOF 
(onde e sistema de eixos terminal) e no punho esferico (onde e sistema de eixos inicial). A caixa na Figura 
5.12 ilustra essa diferenga, mas observe-se contudo que a origem do sistema e a mesma. Assim, nao bastara 
multiplicar os termos A1A2A3 do brago por A4A5A6 do punho, e necessario corrigir a discrepancia do sistema 
de eixos numero 3, por exemplo, atraves de uma pos-multiplicagao de A3 por uma matriz que consta 
simplesmente de duas rotagoes^ 90° em torno de ya seguido de 180"" em torno de xs (original), ou seja^ 

10 

0-100 

0-10 

1 



Rot{x,\%^)Rot{y,m) = 






1 







1 










-1 
















1 








1 








-1 





1 














1 



Ainda relativamente a Figura 5.12 observe-se que os sistemas de eixos nao obedecem todos a 
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metodologia de Denavit-Hartenberg. De facto, segundo esse processo, o sistema de eixos numero 3 deveria 
ter a sua origem na intersecgao de Z2 com Z3 e nao na de Z3 com Z4 como aqui acontece. Isso deveu-se ao 
processo de construgao deste robot a 6 DOF (como a "concatenagao de dois sistemas menores), mas a unica 
consequencia e apenas a de operagoes adicionais para "alinhamento" do sistema de eixos como se acabou de 
fazer. 



Z3=y4=X5 




ys 


4X3 


AZ3 


Z3 


1 


1 

X3 


Esq: Original 
Din Variante 
representado 


Sistema de eixos n^3 

no robot antropomorfico a 3 DOF 

no manipuladora 6 DOF 



xo 



Figura 5.12- Manipulador antropomorfico com 6 DOF e um punho esferico 

A cinematica inversa do manipulador de punho esferico (obtengao de 61, 62, 03, 04, 05 e 06 em fungao de 
F, ii , s e a ) e possivel analiticamente usando um conjunto de passos como descrito de seguida. Da Figura 
5.12 e imediato concluir a seguinte relagao vectorial^ 



■w 



= P - c/ga 



(5.27) 



For outro lado, o ponto Fw e fungao das juntas 0i, 02, 03 (e so dessas) como se pode obter pela 
cinematica directa (5.21). Bastara, portanto, fazer a cinematica inversa para o ponto Fw e obter as variaveis 
de junta 0i, 02 e 03, como demonstrado anteriormente na secgao 5.5.2. 

De seguida deve individuar-se a componente de orientagao imposta por 0i, 02, 03, que se extrai 
tambem da expressao (5.21) e que se esquematiza em (5.28). 



^1^2^3 ~ 







R 



_W^ 















R 



Wx 



R 



Wy 



R 



1 



(5.28) 



Finalmente, a obtengao das variaveis 04, 05 e 06 faz-se como no caso do punho esferico (secgao 5.5.3) 
porque se pode saber o valor da sua componente de orientagao que tem o valor ^Rg = ^^^3^ ' ^^ como a 

seguir se demonstra. A sub-componente matricial de orientagao do end-effector e dada por 
R = R^ R2 R3 R4 R5 Rg , dado que nos produtos matriciais sucessivos, os elementos das 
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componentes de orientagao nunca sao afectados pelos elementos da 4^ coluna ou linha. Esta afirmagao 
justifica-se pela natureza da matriz de transformagao geometrica homogenea, e confirma-se no diagrama 
seguinte: 



TT = 



• • • 



1 



• • • 



1 



• • • 



1 



Desta forma, pode tambem escrever-se que a componente de orientagao da matriz de transformagao 
do manipulador e dada por R = R^ • Rg e portanto- Rg = R3 -R . Recorde-se que se conhece R da 

cinematica directa do manipulador completo, e R3 da cinematica directa apos as primeiras 3 juntas 

atraves da expressao (5.28). Tendo este valor concreto para ^Rg bastara resolver a cinematica inversa do 

punho esferico e assim obter 64, 05 e 06. 

O processo de cinematica inversa de um manipulador antropomorfico (com ate 6 DOF) pode entao ser 
decomposto em duas fases- posicionamento do punho e sua orientagao e que, em resumo, podemos 
esquematizar simbolicamente nos seguintes dois passos principals, onde inclusivamente se assinalam, em 
cada caso com um bordo circundante, quais as partes da matriz de transformagao geral que se utilizam nas 
operagoes: 



Passo 1- 



n s |a| 




^1^2^3 



El 
1 



Passo 2- 



|nj [sj 




Op-1 

K3 

11 p 

1 



w 



[A^A^A^j 



Op-l Op 

Kg Kg 



'R. = 



Ho 



a. 



(A^A^Ag 
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dOi 



1 



Z2C2 



-^1 Ci 
1 
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6. Cinematica diferencial 



6.1 A problematica 

Nas cinematicas inversa e directa abordam-se as relagoes entre coordenadas no espago operacional e 
no espago das juntas de um dado sistema robotico. Todavia, essas relagoes nao dao qualquer informagao 
sobre as caracteristicas do movimento entre duas quaisquer configuragoes, ou seja, quais sao as relagoes 
entre as evolugoes temporals das coordenadas nos dols espagos. Dlto de outra forma, se, por exemplo, a 
extremidade da mao deve descrever um certo deslocamento (Incremento) no espago a sels coordenadas 
durante um dado Intervalo de tempo, que deslocamentos (Incrementos) devem ter as diversas juntas ou vice- 
versa? Estes Incrementos ou diferengas na poslgao e o seu estudo designam a chamada cinematica 
diferencial. Val mostrar-se mals adlante que a relagao entre deslocamentos Infinitesimals nos espagos 
operacional e das juntas e dada pelo Jacoblano do manlpulador. 

Toda esta conjuntura leva ao estabeleclmento de duas deflnlgoes Importantes- caminho e trajectoria. 
Por caminho entende-se um conjunto de pontos no espago (operacional ou das juntas) que deve ser 
percorrldo numa dada ordem; trajectoria define um caminho levando em conta constranglmentos temporals, 
ou seja, sao deflnldos Intervalos de tempo para a evolugao entre duas configuragoes sucesslvas ou, no caso 
llmlte, a trajectoria define a evolugao ao longo de um caminho em fungao do tempo. 

6.2 Transformagoes diferenciais 

6.2.1 Conceitos 

Para expressar a nogao de Incrementos nas coordenadas (no espago operacional ou das juntas) 
Introduz-se o concelto de movimento diferencial geral ou transformagao geometrlca diferencial, ou 
slmplesmente transformagao diferencial. A transformagao diferencial representa um acresclmo infinitesimal 
e, como tal, e vista como uma matriz de transformagao usual que resulta da multlpllcagao de uma 
transformagao diferencial de rotagao seguida de um transformagao diferencial de translagao, ou seja, num 
dado referencial R, tem-se- 

d^T^ = c/^Trans • d^Rot (6.1) 
onde a translagao diferencial e rotagao diferencial se expressam respectlvamente por- 

d^Trans = Trans ( dx, dy, dz ) (6.2) 

d^Rot = Rot ( X, ^^ ) • Rot ( y, ^ J • Rot ( z, ^J (6.3) 



Na rotagao diferencial, a ordem das tres operagoes e arbltraria, como se pode verlficar mals adlante 

em (6.4). De facto, quando se mencionam incrementos infinitesimals, no caso das rotagoes, esta-se a assumir 

rotagoes de um angulo infinitesimalmente pequeno dO ou, formalmente, os llmites das fungoes que traduzem 
as rotagoes quando ^ dO ^ . Se se recordar que lim ( sin 0) — d9 e 11m ( cos 9) — 1 , e possivel 



conclulr para a rotagao diferencial o seguinte- 
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d^Rot = Rot(x,^^)-Rot(y,^J- Rot(z,^J = 



1 

1 -6, 

6, 






1 



1 



1 



-^^ 








^y 


0] 


1 











1 











1 



1 -^. 



^. 


1 



















1 
1 





1 


-^ 


6y 







^. 


1 


-^x 







-^, 


^x 


1 
















1 



(6.4) 



Usando a expressao matricial da translagao diferencial, pode expressar-se uma transformagao 
diferencial partindo de (6.1), substituindo o resultado obtido em (6.4) e finalmente obtendo-se o seguinte- 



<i^Tjv = 



1 








dx] 





1 





dy 








1 


dz 











1 j 



1 -6. 6,, 



1 -S^ 



—S„ 6, 







1 






1 


-^. 


8y 


dx 




^. 


1 


-Sx 


dy 




-6y 


^x 


1 


dz 













1 



(6.5) 



Assim, uma transformagao diferencial e caracterizada por seis componentes que formam o chamado 
vector de deslocamento (movimento) diferencial e e representado por- 



D 



dx dy dz 6^^ 6y 6^ 



(6.6) 



6.2.2 Metodologia de utilizagao 

Dadas estas definigoes, e agora pertinente questionar a sua utilidade e aplicabilidade pratica. Em 
verdade, se um dado sistema de coordenadas ^Tn sofre uma transformagao diferencial, o que se quer dizer e 
o seguinte relativamente a sua nova localizagao^ 

Nova Localizagao = d^Tj^ - ^T^ = t/^Trans • d^Rot • ^T^ (6.7) 

Mas, por sua vez, a transformagao diferencial foi introduzida para ser um acrescimo infinitesimal 
(diferencial) concebida para ser simplesmente tida como um termo aditivo de transformagao geometrica, ou 
seja, deve ser tal que basta adiciona-la a uma qualquer matriz de transformagao geometrica para obter uma 
nova matriz (de transformagao), devendo verificar-se o seguinte- 

Nova Localizagao = ^T^ + d^T^ 



LiV 



(6.8) 



Igualando as expressoes (6.7) e (6.8) vira em sequencia- 



^T^ + d^T^ = rf^Trans • d^Rot • ^T^ 



Rr 



Tm = ^A • ^T 



Rr 



(6.9) 



d^Tj^ = t/^Trans • d^Rot • ^T^ - ^T^ = (t/^Trans • d^Rot - l) ±^ = ^ • ±^ 

Ao factor /S. — d Trans • d Rot — I chama-se transformagao de deslocamento diferencial (nao 
confundir com a transformagao geometrica diferencial) e permite determinar, em fungao de uma qualquer 
matriz representando um referencial em causa, qual o valor do incremento de transformagao diferencial 
para se poder obter a nova localizagao. A transformagao de deslocamento diferencial, face ao exposto, pode 
escrever-se na forma matricial, chamando-se a atengao para a diagonal e linha de zeros- 



R 



A = 






-^. 


6y 


dx 


^. 





-^x 


dy 


-6y 


^x 





dz 















(6.10) 



A transformagao diferencial de um certo sistema de coordenadas (que o e no fundo ^Tn) foi abordada 
implicitamente como sendo vista de um referencial base original, o referencial R. Porem, a transformagao a 
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aplicar poderia ser vista, nao do referencial base R, mas do proprio referencial N que ira sofrer a 
transformagao diferencial. Isto reporta-nos as questoes de pre- e pos-multiplicagao de transformagoes 
abordadas em capitulos anteriores. Assim, se uma transformagao diferencial for vista no proprio referencial 
(N), expressando por isso as transformagoes diferenciais elementares por (i^Trans e d^Kot , vira- 

^T^ + d^Tj^ = ^T^ • rf^Trans • d^Rot = ^T^ (l - rf^Trans • d^Rot) = ^T^ • ^A (6.11) 

6.2.3 Exemplo numerico 

O conceito de transformagao diferencial e naturalmente uma abordagem teorica que, quando 
implementado numericamente, tera alguns erros que poderao ser mais ou menos relevantes. Seja de seguida 
um exemplo para ilustrar esta questao. 



Dado um referencial A = 









1 


10 


1 








5 





1 

















1 



, qual e a matriz de erros na nova localizagao se se aplicar o 



processo das transformagoes diferenciais com seguintes os movimentos diferenciais- d = 



1 0.5 



6 = 



0.1 



it 



? Recordando a metodologia exposta, o procedimento e o seguinte- 



Nova localizagao = A + (iA = (iTrans • dRot • A 



onde dA — A • A . Usando numericamente os vectores fornecidos como os vectores d e ^ (e e aqui 



que se introduz o erro numerico), vira- dA = 



0.1 1 



-0.1 0.5 





1 10 
10 5 
10 
1 

0.1 



0.1 









1 





-0.1 -0.5 



Assim, a nova posigao (aproximada) obtem-se como sendo- A -\- dA = 




1 11 

10 5 

1 -0.1 -0.5 
1 







O valor exacto da transformagao corresponde, alem da translagao indicada, a uma rotagao em torno 
do eixo dos yy com valor 0.1, o que resulta em- 



Nova localizagao exacta = A^^^^ — 



cos(O.l) sin(O.l) 1 
10 

-sin(O.l) cos(O.l) 0.5 
1 

0.0998 0.995 

1 



Efectuados os calculos, vira explicitamente- A^^w — 



1 10 

10 5 

10 

1 
10.95 
5 



0.995 -0.0998 -0.498 
1 



Finalmente, 



I ^novo \ -^ ~r ^^ ) I — 



a matriz dos 

0.002 0.005 0.05 



0.005 0.002 0.001 





erros 



pode 



ser 



dada 



pelo 



seguinte- 



, que corresponde, em termos relativos, a que qualquer 
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termo tenha um erro inferior a 0.5%. 

Em resumo, o uso pratico da transformagao diferencial tern essencialmente vantagens do ponto de 
vista computacional dado que elimina o recurso a fungoes trigonometricas. Todavia, esta utilizagao deve ser 
praticada dentro de limites comportaveis de erros acumulados. 

6.3 O Jacobiano de um manipulador 

Aquando do estudo das cinematicas directa e inversa afirmou-se que se tratava formalmente de uma 
relagao vectorial entre dois grupos de variaveis, no espago das juntas e no espago operacional e que 
simbolicamente se poderia escrever r = F ( q ) , para a cinematica directa e, com as devidas restrigoes de 

interpretagao e condigoes de existencia matematica, q = F~ ( r ) para a cinematica inversa. Se se levar em 

conta que a variagao temporal de uma variavel espacial (distancia ou amplitude angular) traduz uma 
velocidade (linear ou angular) e imperativo pensar no que surge se se derivarem as expressoes acima citadas 



em 

dt 



ordem ao tempo. 

dz d(t) dO di)'^ 



Claramente, 



se 



r = 



X y 



X 



(t) iIj 



entao, 



dx 
lit 



dy_ 
dt 



dt dt dt dt 



onde se identificam 3 velocidades lineares e 3 velocidades angulares. 

dr . . , 
Se se pensar que o vector r indica a postura da extremidade de um manipulador, — - indicara as 

dt 

componentes cineticas dessa mesma extremidade. E assim imediato questionar tambem como se relacionam 
com elas as velocidades das diversas juntas do manipulador. A resposta esta num resultado da analise 
vectorial referente a diferenciagao de fungoes vectoriais, e que, usando a nomenclatura adoptada ate agora, 
se traduz no seguinte- 

(B = J-dq (6.12) 

onde J e designado o Jacobiano da fungao vectorial F . Se F for expressa por 

(n,^2v,^m) = F(gi,g2v,^n). OU de modo equivalente r, = /, (gi,g2v,^n ), ^ = l,2,...,m, o que, na 

linguagem dos manipuladores corresponde a assumir m variaveis cartesianas e n juntas, o Jacobiano tem a 
seguinte forma- 

dri dri dri 



J = 



dqi dq2 
dr2 dr2 
dqi dq2 



dr^ dr„ 



. dqi dq2 



dqn 
dr2 
dqn 



dq^ 



(6.13) 



Para melhor entender esta formulagao basta recordar o conceito de diferencial total de uma fungao de 

varias variaveis como, por exemplo, a duas- x = f {61^62) , donde se tem dx — -w^dOi + ——d02 . 

oOi 062 

Assim, fica claro como se pode obter analiticamente a relagao entre as diferenciais das variaveis no 
espago cartesiano em fungao das diferenciais no espago das juntas. Bastara pensar na sua dependencia com 
o tempo e pode-se escrever sem grandes dificuldades de intuigao o seguinte- 

(B ^ d^ ^ J, ^ A 

-— — ^ • —- ou em notagao compacta r = J • q 

dt dt 

ou ainda, com os devidos cuidados para evitar o abuso de notagao, tambem o seguinte v = J • cD , 
onde o vector v representa as componentes de velocidade cartesiana e cj e o vector com as velocidades das 
juntas (podendo elas tambem ser lineares no caso de juntas prismaticas). 



Cinematica diferencial 



6-5 



Robotica Industrial - V. Santos 



6.3.1 Determinagao do Jacobiano 

O Jacobiano de um manipulador mostra-se assim com um elemento fundamental para relacionar as 
velocidades no espago operacional em fungao das velocidades das juntas. O seu calculo analitico pode ser 
obviamente feito pela diferenciagao das expressoes da cinematica directa como se apresentou. Na Figura 6.1 
ilustra-se um manipulador RR planar com indicagao dos incrementos envolvidos e as equagoes da sua 
cinematica directa. 




Cinematica directa^ 



Figura 6.1 - Incrementos cartesianos e nas juntas de um manipulador RR planar. 



A obtengao das expressoes diferenciais do manipulador na situagao da Figura 6.1 faz-se pelo ja 
referido conceito da diferencial total que utiliza as diversas derivadas parciais^ 



^^ ^ d{L,C,+L,C,,) ^^^ ^ d(L,C,+L,Cn) ^^^ ^ _^^^^ ^ ^S,,)dO, - L,S,,dO, 



do, 



dOo 



^^ ^ d{hSi + hSn) ^^^ ^ d(hSi+L,Sn) ^^^ ^ ^^^^ ^ L^C,,)de, + L,C,,dO, 



(6.14) 



dOi 



dOo 



As equagoes obtidas em (6.14) podem naturalmente reorganizar-se e a expressao da cinematica 
diferencial de um manipulador RR planar resulta de forma compacta em: 



dx 
dy 



—LiSi — L2S12 —L2S12 
LiCi + L2C12 L2C12 



dOi 
d02 



(6.15) 



A matriz do Jacobiano surge explicita e, naturalmente, o seu valor concreto depende em cada instante 
dos valores dos angulos de junta 9i e 62. 

Um outro exemplo aqui apresentado diz respeito ao manipulador RR no espago a 3D que se relembra 
na Figura 6.2, e onde se indica tambem a expressao da cinematica directa, agora com as tres variaveis no 
espago cartesiano, mesmo sabendo-se que ha uma certa dependencia entre elas. 




Cinematica directa ^ 

X = L2C1C2 
y = L2S1C2 
Z = L2S2 + M 



Figura 6.2 - Manipulador RR a 3D e os acrescimos diferenciais cartesianos e nas juntas 
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Pela metodologia descrita anteriormente pode chegar-se sem grandes dificuldades a seguinte 
expressao de cinematica diferencial^ 



d02 



(6.16) 



dx —L2S1C2 —L2C1S2 
dy = L26162 —L2S1S2 
dz L2C2 

E de observar que o Jacobiano em (6.16) nao e quadrado, o que resulta de se terem considerado tres 
variaveis cartesianas e duas variaveis de junta. Nao foram levadas em conta variaveis de orientagao 
cartesiana (que reforgariam a disparidade de variaveis) dado que tambem elas nao sao independentes das 
variaveis de posigao (x, y, z). Todavia, teria sido possivel integra-las sem dificuldades dado que se 
relacionam de forma muito directa com as variaveis de junta como se mostrou no capitulo da cinematica 
directa. 

A obtengao analitica por diferenciagao da cinematica directa e o processo mais natural para obter o 
Jacobiano, mas outros processos existem na literatura como, por exemplo, por calculo vectorial ou por 
coordenadas homogeneas segundo o Algoritmo de Paul. 

6.3.2 Jacobiano inverso 

Ate agora abordou-se a questao de expressar os diferenciais das variaveis do espago cartesiano em 
fungao das variaveis de junta, mas e o problema inverso? Ou seja, como se pode expressar o andamento das 
variaveis de junta dados os andamentos das variaveis cartesianas? Por exemplo, se se quiser que a evolugao 
das coordenadas (x,y,z) do end-effector seja linear (isto e, incrementos dx, dy e dz constantes), o que 
corresponde a descrigao de uma linha recta no espago a 3D, como deverao evoluir as juntas do manipulador? 
Este problema e com certeza de grande importancia pratica, e pode ser designado pelo problema da 
cinematica diferencial inversa. Ha visivelmente uma relagao com a cinematica inversa de manipuladores, 
onde tambem ai eram as variaveis do espago operacional as entidades independentes a custa das quais se 
determinavam as variaveis de junta. Se existir a fungao de cinematica inversa F tal que 
{QiiQ2i---iQn) — F~ (^i,''2v5''m ) ©ntao tambem aqui e possivel obter o Jacobiano dessa fungao inversa que 
se designa por J"^, ou Jacobiano inverso, e ter-se-a <iq = J~ • dr . Todavia, esta designagao de Jacobiano 
inverso pode levar a conclusao arriscadamente apressada, como correspondendo a matriz inversa do 
Jacobiano do manipulador (6.13), o que nem sempre e verdade porque esse Jacobiano pode nao ser quadrado, 
como e o caso em (6.16), e logo nem sequer se poder definir a sua inversa. E por isso comum usar as 
designagoes Jf e Ji para o Jacobiano directo (Forward) e para o Jacobiano inverso . 

Feitas estas consideragoes, surge assim a questao de como se pode obter o Jacobiano inverso, dado ele 
ser fundamental para a determinagao das velocidades das juntas. A definigao leva a que a primeira tentativa 
seja a de diferenciar as expressoes da cinematica inversa, o que e sempre valido se essas expressoes 
existirem. Por outro lado, se o Jacobiano (directo) for quadrado entao pode tentar-se a sua inversao quer 
analitica, quer numerica, e nesse caso sera feita em cada instante, mas deste assunto voltar-se-a mais 
adiante. 

Procure- se obter o Jacobiano inverso para o manipulador RR planar por inversao do Jacobiano 
directo. Simbolicamente pode escrever-se a expressao (6.15) do seguinte modo- 



dx 
dy 



Jii 
J 21 



J 12 
J22 



dOi 
d02 



(6.17) 



Adj (J) 
Pela definigao de inversa de uma matriz ter-se-a- J~ = — — - — , onde a adjunta de uma matriz e a 
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matriz transposta dos co-factores, ou seja- Adj(J) = 



—Jl2 



~J2l 

Jn 



—J 21 



~Jl2 

Jn 



. Por seu lado, o 



determinante de J pode ser ja obtido substituindo a sua real expressao dada em (6.15) e vira- 

det ( J ) = - ( i^5i + 12^12 ) ^2^12 + ^2^12 ( hCi + hCn ) 
Esta expressao pode ser sucessivamente desenvolvida e ter-se-a- 

det( J) = —yLiL2SiCi2 + L2S12C12 ) + [L1L2C1S12 + L2C12S12 ) = 
= hh(CiSi2 - S,C,2 ) = hh smiXOi +02)-0i) = 

— M^*^2 

Prosseguindo com o desenvolvimento do Jacobiano inverso pode-se finalmente constatar^ 

L2C12 — ( LiCi + L2C12 ) 1 
^2*^12 ~ ( A*^i + ^2*^12 ) 



(6.18) 



(6.19) 



J-^ = 



1 



L1L2S2 



L1S2 



C12 S12 

LiCi + 1^2612 M*^i + L/2S12 



(6.20) 



L2 L2 

Apesar do resultado obtido de forma aparentemente facil em (6.20), nem sempre e possivel obter o 
Jacobiano inverso de forma analitica; na verdade, este caso e dos poucos onde o metodo resulta com 
facilidade. A via alternativa da diferenciagao das expressoes da cinematica inversa, por seu lado, oferece 
mais uma possibilidade, em particular quando o Jacobiano directo nao e rectangular. E precisamente esse o 
caso do manipulador RR no espago a 3D cuja cinematica directa esta indicada na Figura 6.2 e a cinematica 
inversa, tal como indicado em capitulos anteriores, e dada por- 



X 



O2 = arctan- 



z — Li 



(6.21) 



x-Ci+ySi 
Rescrevendo a primeira parte da expressao anterior, vira- 

;- — — ^ x^mUi — y cos 61 — O 

cos 61 X 

dx • sin Oi -\- X cos Oi ■ dOi -\- y ■ sin Oi • d6i — dy • cos ^1 = 

^ —dx • sin Oi -\- dy ■ cos Oi 
dui ^ 



(6.22) 



X ■ cos Oi + y ■ sin Oi 

Substituindo os termos de x e y pelos valores respectivos conhecidos da cinematica directa (Figura 
6.2), mais concretamente x = L2C1C2 e ?/ = L2S1C2 , vira^ 



dO, = 



—dx • Si -\- dy • Ci 
L26162 • 61 + L2S1C2 • Si 



-dx-S,+dyC,_ -Sy^^^^^y 



^^2 



^2^2 



^2^2 



(6.23) 



Note-se que semelhante resultado poderia ser obtido pela diferenciagao directa da expressao da 
arco-tangente em (6.21) bastando desde logo recordar que dOi = — — dx + -;z—dy '• 



dx 



dO, = 



^1 



1 + 



T7(-J"" + 



1 1 



1 + 



y\^ X 



dy = 



-y 



x^ + y^ 



dy 



dx + 



^^ — 2^y 

x' +y' 



(6.24) 



.X / \x . 

recorrendo tambem aqui a termos da cinematica directa, apos substituigao, vira^ 



dOi = 



-y 



dx + 



X 



dy = 



-^1 



dx + 



Ci 



L2C2 L2C2 L2C2 L2C2 



dy 



(6.25) 



A obtengao do diferencial da variavel 62 podia-se fazer pela derivagao da segunda expressao em (6.21) 
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tal como se fez para a variavel anterior, mas o processo e muito mais expedite se se atender na cinematica 
directa que z = Li -\- L2S2 o que, por diferenciagao directa, da de imediato dz = L2(72<i^2 ? o^ seja- 



^^2 = 



1 



Z/2(7^ 



-<iz 



(6.26) 



Pode entao escrever-se a expressao final englobando o Jacobiano inverse- 



dOi 
d02 



Si 



c, 



-^^2 -^2^2 







1 



dx 
dy 
dz 



1 



L2C2 



-Si C, 




dx 
dy 
dz 



(6.27) 



L2C2 J L ■ 

Quando nenhuma das solugoes analiticas for viavel so restara a possibilidade da inversao numerica 
do Jacobiano directo. O principio e o de que em cada instante (para os valores correntes das juntas) se pode 
calcular o Jacobiano directo e inverter numericamente a matriz. Se, mesmo assim, o processo for 
computacionalmente incomportavel, uma solugao e o de calcular a priori {off-line) um conjunto de Jacobianos 
inverses em pontes considerados fundamentals ou relevantes, e fazer algum tipo de interpolagao nas 
diversas variaveis para os pontes onde essas inversas nao tenham side calculadas a priori Este 
procedimento requer menos poder de calculo mas em contrapartida exige grande capacidade de 
armazenamento (memoria). 

6.3.3 Recurso a pseudo-inversa 

Mesmo com toda a metodologia apresentada, podem restar os cases em que o Jacobiano directo nao e 
quadrado, logo sem possibilidade de definir a matriz inversa. Para esses cases pode-se tentar recorrer ao 
conceito de pseudo-inversa de uma matriz que se define do mode seguinte. 

Pseudo-inversa de uma matriz (m x n) de caracteristica maxima (isto e com rank(A) = min(m,n), ou 
ainda que o numero de linhas ou colunas linearmente independentes seja igual a menor das suas dimensoes) 

A'(AA')"' <^m<n 

-1 



e a matriz designada por A+ tal que- A = 



m = n 



(A'A)"^A' <^m>n 



Se a matriz for quadrada fica-se na situagao tradicional da inversa. A pseudo-inversa de uma matriz 
possui algumas propriedades interessantes, entre as quais se referem as seguintes- 

J r j=j 
J J J =r 

J^ tem as mesmas dimensoes de J^ 

Na equagao J -x = b , a solugao x = J^-b minimiza o valor de J-x — b (i.e., J-J^-b— b ), ou seja, 

J • J^ representa o valor mais proximo possivel da matriz identidade I. 
6.4 Singularidades 

Come visto, por exemplo nas expressoes dos Jacobianos em (6.15) ou (6.16), e pela propria definigao 
do Jacobiano, se as relagoes da cinematica directa forem diferenciaveis (como o sao praticamente todos os 
modelos continues), entao o Jacobiano e sempre definido. Por outre lade, o Jacobiano inverse mesmo quando 
identificado por uma expressao analitica, pode nem sempre ficar definido para todos os valores das variaveis 
de junta, ou seja, para todas as configuragoes do manipulador. Para entender este facto, basta atentar na 
expressao (6.20) para o manipulador RR planar onde, se 62 for 0° ou 180°, o Jacobiano inverse nao tem 
definigao, ou ainda na expressao (6.27) para o manipulador RR no espago a 3D onde se 62 for ±90'' tambem 
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esse Jacobiano inverso nao tern definigao numerical De facto, nestes casos, o Jacobiano (directo) e singular 
(tera determinante nulo) e o Jacobiano inverso e nao definido, e diz-se que a respectiva configuragao do 
manipulador e uma singularidade. 

Fisicamente, o que significa uma singularidade? Em resumo, e uma situagao (configuragao do robot) 
na qual seria necessario impor velocidades infinitamente altas numa ou mais juntas para manter 
determinadas velocidades no espago operacional. Dito doutro modo, havera um actuador (ou mais) cujo 
controlo sera sempre insuficiente para cumprir as velocidades desejadas no espago operacional. Tambem se 
diz, por isso, que numa situagao de singularidade ha a perda de um ou mais graus de mobilidade que, 
quando o numero de graus de liberdade no manipulador for menor ou igual a 6, se diz perda de um grau de 
liberdade. 



Trajectoria rectilinea 

do end-effector que 

sera interrompida na 

singularidade 





de^ =^dx + -^dy 



LIS2 



LIS2 



dOi = -r^d^ + -T-?^dy 



de, = -h2^-±h^dx - ^^\ t ^^'' dy 



dO, = 



1 



L2C2 



dz 



LiL,^, L1L202 ^^2 

Figura 6.3 -Situagoes de singularidade para dois manipuladores nos limites do espago de trabalho. 

A Figura 6.3 ilustra duas situagoes de singularidades de manipuladores simples; a esquerda, no 
manipulador RR planar, quando o segundo angulo de junta atinge os 0° nao mais e possivel ao robot 
continuar o movimento, por exemplo, na execugao de uma recta a velocidade constante do end-effector., dado 
que nenhum movimento da junta 2, independentemente do comportamento da junta 1, satisfaria essa 
necessidade. Matematicamente a velocidade da junta 2 cresceria desmesuradamente ao aproximar-se do 
valor 0. Na mesma figura, a direita, esta um outro exemplo onde as expressoes diferenciais tem uma 
interpretagao fisica muito clara e intuitiva- na situagao ilustrada, 62 = 90°, nenhuma variagao de 62 sera 
suficiente por si so para alterar a cota z do end-effector e, por outro lado, nenhuma variagao de 61 sera 
suficiente para alterar a coordenada x ou y; isso e de facto assim porque os termos da direita das expressoes 
tendem para infinito quando 62 tende para 90"^. 

As singularidades mencionadas dizem respeito a situagoes nos limites do espago de trabalho. Em 
manipuladores com mais graus de liberdade e possivel encontrar singularidades no interior do espago de 
trabalho. Essas dizem respeito normalmente a alinhamento de elos interiores, como cotovelos, por exemplo. 
Estas singularidades representam problemas serios no controlo dos manipuladores e nao devem ser 
descuradas nas fases de planeamento e execugao de trajectorias, por exemplo. 
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Equation Chapter 7 Section 1 



Capitulo 7 



Introdugao ao 

planeamento de 

trajectorias 




_tf^ V) (^/-^o) 



4=^±J^- 



2 V4 6» 
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7. Introdugao ao Planeamento de Trajectorias 



7.1 Tipos de movimento 

Num manipulador, depois de se saber como relacionar o espago das juntas com o espago operacional, 
quer em termos geometricos (cinematica directa e inversa), quer em termos cineticos (cinematica 
diferencial), e necessario proceder ao que se chama planeamento de trajectoria. Assim, o planeamento de 
trajectoria engloba o conjunto de estudos e metodos que permitem definir os regimes de velocidade dos 
diversos actuadores de forma a fazer o manipulador cumprir os objectivos de movimentagao ou deslocamento 
esperado (planeado). A partida, num robot industrial, estes objectivos podem ser simplesmente o 
deslocamento do end-effector entre dois pontos em repouso no espago de trabalho, durante um determinado 
intervalo de tempo, como e o caso tipico de manipulagao (como a paletizagao ou transferencia) ou, no outro 
extremo de complexidade e exigencia, a execugao de uma trajectoria bem definida do end-effector no espago 
operacional e obedecendo a criterios temporals precisos, como sao casos de algumas operagoes continuas 
(pinturas, polimento, cordoes de soldadura, etc.). O primeiro tipo de movimento e designado o movimento 
ponto-a-ponto e o segundo movimento de trajectoria continua. 

No movimento ponto-a-ponto o percurso efectivo da garra nao e conhecido a partida dado que as 
configuragoes intermedias entre os pontos extremos nao sao levadas em conta para cumprir este movimento. 
No movimento de trajectoria continua e o caso oposto, todos os pontos de passagem da garra estao definidos 
a partida, seja de uma forma analitica seja de forma numerica, e ai com grande precisao. Numa solugao 
intermedia, e possivel fazer planeamento de trajectoria entre dois pontos, mas com especificagao de um 
conjunto de pontos intermedios nos quais a configuragao da garra e mandatoria e, por isso, cumprida. Esta 
abordagem e a mais versatil em termos de implementagao pratica. Na verdade, uma sequencia de 
movimentos ponto-a-ponto com espagamentos fisicos muito pequenos entre os pontos quase se assemelha, em 
termos praticos, a uma trajectoria continua no espago operacional! 

7.2 Abordagens para planeamento de trajectorias 

Antes de proceder ao planeamento de trajectoria e subsequente execugao do movimento deve atender- 
se a duas naturezas de constrangimentos^ 

1- Dar prioridade ao caminho a executar pelo end- effector vlo espago operacional, que pode ser ditado 
pelo conhecimento previo de obstaculos no espago de trabalho, ou pela necessidade de percursos obrigatorios 
pela natureza do processo subjacente, ou entao... 

2- ...Dar mais importancia a dinamica do movimento do manipulador, em particular na continuidade 
e suavidade nas velocidades e aceleragoes nas diversas juntas para nao provocar solicitagoes desmesuradas e 
irregulares nos respectivos actuadores. Isto implica definir o planeamento de trajectoria das juntas do 
manipulador. 

Neste segundo caso podem desde ja adiantar-se algumas vantagens, como mais adiante melhor se 
percebera- 

• A trajectoria e planeada nas variaveis directamente controladas (variaveis associadas as juntas) 
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• O planeamento e feito com menores custos computacionais 

• As trajectorias de juntas sao normalmente simples de planificar. 
Por outro lado, ha uma desvantagem obvia- 

• As posigoes das extremidades dos elos nao sao controladas e, por isso, podem descrever um 
percurso muito irregular, com consequencias tambem no end-effector (pense-se por exemplo na 
manipulagao de um recipiente contendo liquidos e nao completamente fechado!) 

7.3 Planeamento nas juntas 

Planear uma trajectoria no espago das juntas significa determinar a evolugao de cada junta ao longo 

do tempo de tal forma que sao verificadas determinadas condigoes cinematicas da junta- posigao, velocidade, 

e ate aceleragao, no ponto inicial e no ponto final. Ou seja, um movimento deve decorrer desde o instante to 
ate ao instante tf partindo do valor inicial de junta Oq ate ao valor final de junta Of , com uma velocidade 

inicial (Iq) = Oq e uma velocidade final 0(^tf^ = Of', mais ainda, pode desejar-se uma aceleragao inicial 

(to) = Oq e tambem uma aceleragao final [tf) = Of . 

7.3.1 Fungao para a continuidade da velocidade 

No caso mais simples tem-se uma posigao de partida e uma outra chegada, e as velocidades inicial e 
final iguais a zero. Pretende-se obviamente que a velocidade angular seja continua para evitar aceleragoes 
teoricamente infinitas e portanto esforgos gravosos para os equipamentos fisicos. 

Dito de outra forma, quer-se portanto que a equagao (t) = tenha duas raizes para t=to e t=tf e 

seja uma fungao continua. Muitas classes de fungoes serviriam o proposito destas condigoes, mas talvez a 
mais simples seja a de considerar que e uma polinomial em t. Assim, pelo facto de ter duas raizes, a 
expressao da velocidade da junta sera uma polinomial de 2^ ordem, ou seja, 6(t) devera ser de 3^ ordem, 
donde saem as seguintes expressoes genericas- 

0(t) = ao + ait + ast^ + a^t^ (7.1) 

Oit) ^ ai +2a2^ + 3a3^^ (7.2) 

0(t)^2a2 +6ast (7.3) 

Sem perda de generalidade pode assumir-se que o instante to igual a 0, ou seja, e o inicio da 
contagem do tempo, e assim as expressoes anteriores tem uma tradugao grafica como ilustrado na Figura 
7.1. 




d0/dt 




d^e/dt'^ 







tf t tf t tf 

Figura 7.1- Curvas de posigao, velocidade e aceleragao 

Feito este raciocinio, torna-se agora necessario determinar os termos ao, ai, a2 e as na expressao (7.1) 
e seguintes. O processo e directo e na simplificagao assumida pode escrever-se o conjunto de condigoes a 
verificar como sendo- 



e{0) = o; 0{tf) = Of, e{0) = Oo; e{t}) = ej 



(7.4) 
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Combinando as expressoes (7.1) e (7.2) com as condigoes em (7.4) pode escrever-se- 

Oq = aQ Ol^tf) = ttQ + aitf + a2t'f + a^tf = Of 

e 
Oq = ai = 0[tf) = ai+ 2a2tf + 3a^t] 

o que resulta sucessivamente em^ 



Ot = Oo+ a^tj + a^t} 
= 2a2tf + Za^t) 



<^ 



Of — Oq — a^tf + tt'^tf 
2a2 = —3a^tf 



<^ 



Of-Oo ^--a^t^f +astf 



<^ 1 



0^2 = "2 ^^^^ 



3 

02 = --^(6>/ -^o) 



t 



'/ 



Pode-se portanto fazer as substituigoes todas em (7.1) e obter o seguinte polinomio para a evolugao 
das juntas: 



0(t) = Oo+^{Of-Oo)t'-^{Of-Ooy 



ti 



t) 



(7.5) 



A expressao obtida em (7.5) serve, como visto, para a situagao onde as velocidades inicial e final sao 
nulas. Caso nao o sejam, tendo-se portanto valores genericos Oq e Of , a expressao mais geral poderia ser 

derivada por um processo identico ao de (7.5) e resultaria no seguinte^ 



0(t) = 6*0 +Oot + 



-^{Of -Oo)-—Oo -—Of 



[tf 



t 



i 



t 



'/ 



t' + 



-J(^/-^o) + 4(^/+^o) 



t' 



(7.6) 



7.3.2 Planeamento nas juntas com pontos intermedios de passagem 

Por vezes, pode ser conveniente ou necessario especificar uma trajectoria onde haja pontos 
intermedios de passagem da junta {via points) onde a sua velocidade nao tem necessariamente de ser zero. 
Um trogo completo entre um ponto de partida e um ponto de chegada constituir-se-a, pois, pela concatenagao 
de sucessivas fungoes individuals, mas agora a velocidade final e inicial nesses diversos trogos nao e 
necessariamente nula. Em termos praticos, as posigoes no espago das juntas obtem-se por cinematica inversa 
sobre as configuragoes dos pontos de passagem no espago operacional, como esboga a Figura 7.2. 



Espago das 
juntas 



Gr 



e 



'A 
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To 



Ta 



Tb 






ff 



Pontos intermedios - via points 



Figura 7.2 - Planeamento com via points 

Todavia, levanta-se agora a questao^ se a velocidade das juntas no ponto de partida e de chegada e 
nula, qual sera a velocidade da junta nos pontos intermedios de passagem? O utilizador (humano ou 
software) pode nao conhecer essas velocidades, ou mesmo nao ter informagoes para as impor de forma 
eficiente (como, por exemplo, tendo a certeza que nao impora esforgos mecanicos devido a grandes 
aceleragoes no manipulador); tres alternativas se apresentam para resolver o problema- 

l) As velocidades nos pontos de passagem sao conhecidas no espago operacional e ter-se-a de aplicar o 
Jacobiano inverso do manipulador para as conhecer no espago das juntas. 
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2) O sistema (planeador) escolhe as velocidades aplicando uma qualquer heuristica no espago das 
juntas ou no espago operacional. Adiante explica-se um exemplo de uma heuristica apropriada. 

3) O sistema escolhe as velocidades nos ''via points' de forma a impor curvas de aceleragao continuas. 
Este caso implica mais definigoes no polinomio 0{t)'- tera agora de ser de 5^ ordem e nao apenas de 3^ como 

definido em (7.1). 

Das tres possibilidades, a mais comum, e talvez mais facil de aplicar com resultados praticos quase 
sempre aceitaveis, e a segunda abordagem ligada a questao da heuristica. O principio e o de fazer uma 
especie de interpolagao das velocidades medias entre dois trogos adjacentes. Por exemplo, se as velocidades 
medias em dois trogos consecutivos (separados pelo via poind tiverem sinais (sentidos) diferentes, entao o 
ponto de passagem e tido como o ponto de viragem isto e, com velocidade nula. Caso contrario, a velocidade 
no ponto de passagem e dada pela media das velocidades medias em cada trogo de cada lado do via point 




Ia tfi tc tf 

Figura 7.3 - Processo heuristico de determinagao da velocidade de junta nos via points. 

No exemplo ilustrado na Figura 7.3 a velocidade de passagem quando a junta chega a 9a e nula 

0—0 0—0 
porque a velocidade media entre Go e 9a, isto e, , e a velocidade media entre 9a e 9b, isto e, 

tem valores algebricos distintos (ou seja, sinais opostos). Graficamente, isso observa-se pelo valor da 
derivada associada aos segmentos de recta respectivos; assim 0^ — . Para 9b essa situagao repete-se mas 
para 9c ja nao! De facto a velocidade Oc , por este processo, seria determinada pela seguinte expressao- 



».=i 



Of - Oc Oc - Ob 
tf — tc tc — ts 



Naturalmente, e possivel fazer um planeamento sem ter de recorrer a uma sequencia de polinomios 
de 3° grau. Tendo o poder computacional adequado, pode recorrer-se a polinomios de grau arbitrariamente 
elevado ou mesmo a outras fungoes que proporcionem "suavidade" como as splines ou mesmo fungoes 
transcendentais. Todavia, em aplicagoes praticas o polinomios de 3^ ordem e muitas vezes suficiente, e por 
vezes ate excessivo para as exigencias dos problemas. 

7.3.3 Alternativa a polinomios de ordem superior 

Em alternativa a um planeamento com polinomio de 3^ (ou maior) ordem ha obviamente a 
possibilidade de evolugao linear do valor da junta mas, consequentemente, ha descontinuidades na 
velocidades e logo aceleragoes desmesuradamente grandes com consequencias na estrutura fisica. A Figura 
7.4 esboga as curvas de posigao, velocidade e aceleragao da junta. 
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Figura 7.4 - Evolugao linear e a descontinuidade na velocidade 

Para evitar as limitagoes da evolugao linear (com severas limitagoes de implementagao pratica, alias) 
pode procurar-se ter uma evolugao linear mas com periodos de aceleragao limitada no fase de arranque e na 
fase de paragem. Isto corresponde a um andamento com aceleragao inicial, uma velocidade constante e um 
periodo de desaceleragao constante. Graficamente, a posigao e descrita por uma curva linear com 
extremidades parabolicas (parabolic blends) como se pode ver na Figura 7.5. 

0(t) r 

^ ^ Trogo 

linear 



CO(t) 




Trogo 
parabolico 







h 



tf t 



tb tm tf 

Figura 7.5 - Trogo linear com extremos parabolicos, ou o classico movimento com rampas de aceleragao 

No trogo parabolico entre e tb, com aceleragao constante ( ^ ) e velocidade inicial nula, e com base na 



equagao tradicional de um parabola e nas relagoes fisicas entre espago, velocidade e aceleragao, tem-se^ 



{i.D 



Por outro lado, a velocidade atingida no fim desse trogo parabolico e necessariamente igual a 
velocidade no trogo linear para haver continuidade de velocidades, o que permite escrever^ 

Orr, — 0^ 



^{h) — ^h — ^h — 



^m % 



(7.8) 



Ainda da Figura 7.5 e claro que- 



U 



t =^ e 



^m — ^n + 



Of — Oq 



Por outro lado, com base em (7.7), tambem e obvio que^ 

^6 = ^0 + o ^4 



Substituindo (7.9) e (7.10) em (7.8), vira uma equagao do segundo grau em tb- 

1 

— I 
2 



-0ti + et,*-i = e, + ^-i^ 



~ ^0 ~ Ti^h 



(7.9) 



(7.10) 



(7.11) 



ou ainda 



cuja solugao e dada por^ 



et! - 9ktf + {ej - 9o) = 
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_tf ^^OH}-AO{Of-Oo) 



U=^± 



(7.12) 



2 29 

que indica qual o instante em que termina um trogo parabolico e o instante em que comega o outro 
quando a aceleragao desejada e , o angulo inicial e Oq , o angulo final e Of e o tempo de execugao da 

trajectoria e tr. 

Naturalmente, para que (7.12) tenha significado fisico o radical tem de ser nao negativo, o que leva a 
impor a condigao tf — 4:0 (^Of — Oq^ > , que se reduz a condigao principal- 



> 



HOf-Oo) 



t 



(7.13) 



'/ 



A expressao (7.12) poderia ainda apresentar-se numa forma com interpretagao mais intuitiva como a 
seguinte^ 



U 



k-'-^±n- 



tf ^ [Of - Oq 

4 



(7.14) 



2 V 4 

De, facto a expressao (7.14) permite relacionar directamente a obtengao dos instantes de actividade 
dos trogos parabolicos com base na aceleragao desejada nessas fases. Da mesma expressao ainda se extrai o 
interessante resultado sobre a menor duragao possivel do trogo linear (que e zero) e que ocorre quando o 

radial e zero, ou seja, quando a acelera.ao e dada po. = 'MjzM . 

Finalmente, e digno notar-se que tambem e possivel (e nao invulgar) fazer planeamento de trajectoria 
com trogos parabolicos em casos com pontos de passagem intermedia {via points). O raciocinio da abordagem 
e similar aos ja discutidos e na literatura ha autores que detalham o processo que nao se assume prioritario 
no ambito do presente texto. 

7.4 Planeamento no espago operacional 

7.4.1 Principios 

Se a tarefa do manipulador exigir um dado percurso no espago operacional (cordoes de soldadura, 
linhas de polimento, processos de pintura, etc..) o problema passa agora a ser o de garantir que as juntas se 
movam de tal forma que o percurso do end-effector se faga conforme o requerido e de forma continua, ou seja, 
melhor do que ter uma sequencia, por maior que seja, de pontos intermedios de passagem. A questao nessa 
alternativa de inumeros pontos de passagem e a necessidade de computacionalmente ter-se de recorrer a 
resolugao em tempo extremamente curto (igual ao do periodo de actualizagao do sistema de controlo do robot) 
das equagoes da cinematica inversa. 

Em casos muito simples (quer de manipuladores quer de trajectorias no espago operacional) pode 
resolver-se a priori a questao da cinematica inversa de forma analitica. Por exemplo, pode pensar-se num 
manipulador RR planar onde se quer que o end-effector descreva um segmento de recta parametrizado da 



seguinte forma- 



x(t) = --t 
^^ 4 , 

y{t) = 2t 



"■I 



, como se ilustra na Figura 7.6. 
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Cinematica inversa do manipulador RR 



Oo = iarccos 



X^+y^-ll-I^ 



ft = arctan 



y{L-^ + ^2 ^^^ ^2 ) ~ ^^2 ^^^ ^2 
x{L-^ + ^2 COS ^2 ) + 2/^2 ^^^ ^' 



2 J 



Figura 7.6" Execugao de um segmento no espago operacional 

Admitindo bragos iguais e de comprimento unitario, as equagoes da cinematica inversa do 
manipulador RR, indicadas na Figura 7.6 podem rescrever-se de forma simplificada- 



Oi(t) = arctan 



2t(l + cos6>2) -I-- tjsin^2 
-- tj(l + cos^2) + 2tsin^2 



^2 ( ^ ) = ± arccos 



7 \2 

^-t\ +4^2-2 



Na redundancia de 62 pode optar-se pela solugao com sinal negativo que corresponde ao representado 
na Figura 7.6. Assim sendo, obtem-se umas curvas para 9i e 62 sensivelmente como as indicadas na Figura 

7.7. 
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Figura 7.7 - Evolugao das juntas 62 (esq.) e 9i (dir.) para o manipulador RR executar uma linha recta 

Este exemplo da resolugao analitica e pouco mais do que um exercicio academico porque, na verdade, 
nao resolve o problema apresentado logo de inicio, ou seja, na pratica, a cinematica inversa tem de ser 
calculada para todos os pontos necessarios ao controlador para levar a cabo o movimento desejado. 

Ha muitos trabalhos nesta area e diversas metodologias de abordar o problema sem ter de recorrer 
tao exaustivamente a cinematica inversa; da literatura e merecedor destacar, por exemplo, o processo dos 
quaternioes duals. 
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7.4.2 Problemas no planeamento do espago operacional 

Quando se faz planeamento no espago operacional podem ocorrer alguns problemas dos quais se 
destacam os seguintes- 

• Pontos intermedios da trajectoria cartesiana inatingiveis 

Apesar de os pontos de partida e chegada estarem no espago de trabalho, ha alguns pontos 
intermedios que nao sao atingiveis (Figura 7.8) 



Regiao 
inatingivel 




Espago de 
trabalho 



Figura 7.8 - Regiao inatingivel para um manipulador RR 

• Grandes velocidades das juntas proximas das singularidades 

Este problema nao e novo dado que ja se abordou a questao das singularidades antes. Porem, nao sera 
nunca demais alertar para os riscos praticos da execugao de trajectorias arbitrarias no espago operacional. 




Fase de grande 
velocidade 



• Pontos de partida e chegada atingiveis com configuragoes diferentes 

Neste caso destacam-se as situagoes em que as configuragoes de partida e chegada, por razoes 
construtivas ou de ordem fisica, nao tem uma relagao de continuidade na evolugao de uma para outra. A 
estas situagoes estao frequentemente associados os limites fisicos das juntas. 
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8. Introdugao a Visao por Computador 



NOTA- Slides apresentados 

NB- Nas paginas seguintes incluem-se os slides apresentados na aula. Notar que e um mero resumo 
da materia e nao constitui elemento de estudo suficiente. Os apontamentos tirados das aulas e os livros e 
restante bibliografia recomendados sao as referencias fundamentais. 

Resume dos topicos abordados 

Parte I - Introdugao e generalidades 

Definigao e areas da visao por computador 

A imagem digital 

Tecnicas de iluminagao 
Parte II - Geometria da Formagao de Imagem 

Transformagao geometrica 

Calibragao da camara 
Parte III - Processamento a baixo nivel 

Relagoes entre os elementos de imagem (pixels) 

Ferramentas para processamento espacial de imagem- filtros e tecnicas. 
Parte IV - Abordagem a medio nivel e morfologia 

Operadores e operagoes morfologicas 

Segmentagao 
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; ( 



♦ Para objectos de superficies suaves e regulares 



->--------;- 



Retro- i I umi nagao (contralyz) 

♦ Para imagens a dois nfveis onde so a geometria dos 




iectos tenha interesse 






Luz estruturada: projecgao de pontos, linhas ou 
grelhas na superffcie de trabalho ( 1 f ( 



♦ Util para a percepgao tridimensional de objectos. 



Tecnicas de Tluminacao-nustracao 



4r 



♦ 



numinagao difusa 

^ ; ! ^ ; ! ^ 

■ Eliminar sombras 



# Luz estruturada 



„j — ^.^.^..j.^.^ 



AniJise geometrica 



♦ 



♦i Retro- i I u mi nagao 4 

■ Alto contraste-imagens binarias 




DilTiasing 
surface 



Shadow 



Light source 



I luminagao direccionada 



Realce de propriedades (gebmetria, textura) 






CoHimated' 
source ^^ 




^y, ,^TTTT^T 



Uuz Estrutufada: Principios - I 



^ 




Projecgao de padroes visfveis numa superffcie 

* Projecgao com feixes laser ou outras fontes coerentes 
Percepgao dos padroes da imagem visfvel e extracgao das 



propriedades 

( ; ; < 




~f 




tuz Estruturada: Princfpios - ll 



4r 



y,,,^^^^^ 



Camara posicionada a 
distancia r(desconhecida) do 
objecto e a altura h 
(conhecida) do feixe laser 



♦ y- coordenada do ponto do. 

3 

padrao luminoso na inrageml 



obtida 



; '. 



Por simples relagao de 
triangulos, sabendo a 
distancia focal fda camara, 

f ; < ; ; < i ; ( r ; 

determina-se a distancia rdo 
objecto 



Camera 

Focal 

Point 



Laser 

D 



SmPLIFIED PROJECTION 



f+r 



<^i^ 



-^ 




image plane 



object h 



laser beam 



h 



f r+f 



r = 



rn 



-f 



Exemplos de 
Retro-l 



^ 




e de tuz Estruturadci 



# Conjunto de chaves sobre 
superffcie translucida 



iluminada por "baixo" 
Grande contraste na 
imagem obtida. 



y^^^^^^^^^ 



-♦f Dois feixes de luz 

f ; i ; ; i ; : 

cbihcidentes nunri piano 

f • * f • * f ' ; 

perdem essa coihcidencia 

i ': * i ' * ■ : * ■ ' 

q ua ndo prbj ictados sobre 

I I I [ I \ [ I I [ I I 

u ma su perf ici e a u ma cota 

:■ • '■ y ^ '■ h ' '■ h • '■ 

diferente Bo piano Be a|^ 









"] ;- 



"] ;- 



"] f" 



Visao por Computador - 



; ( 

; i 

; i 



; i 



Geonnetria 



; '. 



; i 



; i 



; ( 



Parte I J 



da Forrnagao da I magem 




^y, ,^TTTT^T 



Geometria da formacao de imagem-resumo 



4r 



-S * ,,,,,y,,,^^^^^ 



"] ; 



J ^ 



"] f 



^y,,,,,^^^ 



"] ; 



"] ; 



♦ A transformagao (geometrica) de perspectiva 

Transforma pontos do espago 3D em pontos no 



piano 2D 



„j — ^.^.^..^.^ 



Coordehadas do muhdo real 



Coordenadas da innagem (Camara) 



;_ ■: 



Di Stand a focal 



^.^..^.^.^.^.^.^.^.j. 



Obtengao das coordenadas da i nnagenn a partj r das 
coordenadas do mundo real 1 



Coordenadas cartesianas e coordenadas 
homogeneas \ 



\ 'r I , : \ , : I \ 'r I \ 'r I \ 'r I \ 'r I \ 'r I \ 

______; ^ : ; ^ : ; ^ ......... '•■- J * '•■- J * I J * '•- J * '•■- J * '•■- J 

H A transf ornnagao de perspectiva i nversa e o seu 






uso inconciusivo 



Geometria da I magem - 1 




y y y y 

Ponto real e ponto na ihnagem 

Ponto real: w^(X,Y,Z) 



Ponto na i magem: C^(x,y) 



y : ) y : : y '. 

Relagoes de distancias: 



Piano da imagem 




Geometria da I magem - tl 



4r 



-S * ,,,,,y,,,^^^^^ 



; ■: 

; i 

; i 



y,,,,,^^^ 



>--------;- 



# Abordagem integrada das coordenadas 

'. [ I '. I I '. I i '. [ i '. [ I '. [ I '. 

♦(Coordenadas homogeneas de um ponto 

\ m Ponto real: W^ ^ (AX, AY, AX, A), ^0 

f Ponto inriagem: c^ ^> ? (resulta da transformagao) 

# Transformagao de perspectiva P 



Cu = P w, 



h 






P = 



1 








g 

1 







1 



^ 1 ^ 

— 



1 



g 
p 



i 






^h = 



i ^-O- 

1 

- 



b 



D 








1 






1 



ytx 



kZ 



C/.= 



y^X 



y^r 



kZ 



-kZ 



+ yl 



Geometria deTmagem - I (1 




: : I ; ( I ; ( I ; ( I ; ( 

Coordenadas calculadas na imagem 
(ponto c) do ponto real (w) 



A co6rxiena9a z nao tern 

As coordenadas x e y obtem-se em 
fungao das coordenadas reais (X,Y,Z) e 



c = 



X 

y 
z 



' n ( ' i ; '• n ( 

determinagao in versa 



(coordenadas reais a parti r das 
coordenadas de innagem) seria 
obtida pela transfornnagao inversa ^ 
ocpressa pelb segulnte Wu, = P"^ c 
onde P-^ seria como indicado. 

'■ ' < i ' < i 

'■ ! * ^ ; * y 

Porem, a transfornnagao nao produz 
pontos no espago 3D. . . I 



h 



kX 


, ' kZ 

j £.„. 

kY 


, ^ kZ 
k 



% 



kZ 



2X 

X-Z 
AY 

A-Z 

xz 

l-Z 



k- 



kZ 



^-™™-^ 



,-1 



J ^ 



1 











1 



^y,,,,^^^^^ 





'. 





1 
1 

J 










Ca I i bracao da Ca ma ra 

^^^^^^ ^ — r. V *^-> r — -^ r y : ^^^^^^ , — ^ ^ v-- 



; ■: 

; i 

; i 



; i 




4 i ,,,,,y,,,^^^^^ 



Quando os sistemas de coordenadas da 



(raniara e do iriuhdo^ 


















Necessidade de adequada transformacao 

y ] '; y \ '; y \ ^ I : ^ I : ^ I : ^ y i '; 

geometrica da camara antes da perspectiva 



; '. 



Simples relagao de transformagoes... 



_ ^y 



c 



c 



w 



= ("Tc) 



-1 



«w=%. 



R 



w 



e transformagao perspectiva: 



^ ; < ^ ; < f ; < f 

— \ ^ / — "i "' i" ■ i" t ■iv 



V y» 





"] ;- 



"] f" 



Visao por Computador - 






; ( 

; i 

; i 



; '. 



; i 



; i 

; i 



Parte iJ 1 



; < ^ ; < ^ ; < ;. ; < i 

Processarriento a Baixo Nfvel 




Tmagem em baixo nivel - sumario 



4r 



4 



-S * ,,,,,y,,,^^^^^ 



; ■: 

; i 

; i 



/\/ 




basicas entre pixels 



Vizinhangasl 



Criterios de distancia 



; '. 



# Pre-processamento 

t : i i ■ : i ■ 

■ ps f I Itros de convol ugao 



Detecgao de pixels isolados 

> < L > < L > < L •' < L 

Tecnicas de suavizagao 
Tecnicas de Realce 




de areistas 



Limitagao e binarizagao 




zagad de i rfiagens bi narias 



^y, ,^TTTT^T 



Ty^TTTTTT^T 



Relacoes entre pixels 

.^^„^^ ^ — ^^^ — ..«^.-^.-^ — -^-^-^ — .... — ^ — ^^^„^^ . ^.......... — — g — . ^ — .. — ..^....... — 



4r 



-s *- 



y,,,^^^^^ 




\ \ \ \ \ \ \ \ \ \ \ \ \ \ \ \ \ \ \ \ \ \ \ \ 

Vizinhanga de um pixel {x\^ de yCvVe/s vizinhos) 



N. (horizontal e vertical) 



s 



N 



D 



N8 = 




N^uNd 



^ \ \ \ \ \ \ \ \ \ \ \ \ \ \ \ \ \ \ 

# Medldas de distancia entre pixels 



Eudidiana 






^ 



J 



D4 (OU City-blOCR) \ \ D,{p, q) = \p^ -q^\+ \p^ - q 

\ ' * 

\ \ > \ \ ^ \ \ \ \ \ '^ \ \ '^ \ \ '^ 

D8 ( OU chessboards J A [p^ ^) = "^^Apx - ^; 



J 



P.-q 



y 



^y, ,^TTTT^T 



Ty^TTTTTT^T 



Pre-processamento de imagem 



4r 



; ■: 

; i 

; < 






♦ Abordagens 






Espacial - sobre os p/xe/s da imagem 

Na frequencia - Tr^nsformadas de Fourier (nao se 



abordam aquij) 






# Na abordagem espacial 

( i : ( ; : ( f 3 ( ; : ( 

j, .. . . >. .... ... I ....... j ...... . ,K ...... i i .!. ... . . . . L . ..... j . ...... .^. ....... i. ......;.. . 






Criagao de u ma nova imagem g(Ky) = h^^^^^ 

I ♦ h() : operador de pre-processamento que opera numa 



vizinhanga de cada pixel 



> Uso de mascaras de convolugao (ou janelas ou 



filtros) 






; i 

; i 






; < 

; < 

; < 

; < 






; i 



"] ""-^ 



Matriz de coeficientes apropriados a determinado tipo de 
tratamento ou detecgao de propriedades 



Pri ncipid da uti I izacao de um f i Itro 



4r 



-s *- 




E ; J t ; i i ; J E ; J E ; J E ; J E ; J E ; J 

Novo pixel e. fungao do yCvVe/ original e do fi Itro 



H^ 



g 



\ \ N 

{x, y) =2 



w,. • /?, 



(=1 



onde p, pertence a vizinhanga do ponto em causa 

\ '^ \\ \ \ \ \\ \ ■ \ '; \ \ \ - \ 

♦ Note-se que g(Ky) pode ser o valor di recto do novo 

j.. J.. 

ou ser usado de forma indi recta para o definir. 



pixel. 



Os coeficientes de um filtro de 3x3 



i—H-" " r—H 



w1 


w2 


w3 


w4 


w5 


w6 


w7 


w8 


w9 



,,,,,,..J 






^y, ,^TTTT^T 



Ty^TTTTTT^T 



Filtro para detectar pontos isolados 



4r 



♦ Numa inriagem binaria (p/>re/sc6m valbres ou 



1), o seguinte filtro pode ser usado para 
detectar se um pixel € um ponto isolado no 



meio de outros. 



-1 



-1 



-1 



-1 



8 



-1 



-1 



-1 



-1 



'\'- 



Se g(x,y) = 8 ou -8 ^> o ponto (x,y) e isolado! 



Note que OS valores de - 7/ - 6, - 5, . . .,6, 7 

as outras 





„j — ^.^.^..^^™ 



Tecnicas de suavizacao (smoothing) 



4r 



-S * ,,,,,y,,,^^^^^ 



; ■: 

; i 

; i 



J ^ 



J ^ 



J ^ 



"] f 



"] ; 



^ '• ^ ^ ^ ^ ^ 

( ; ; i ; ; S ^ ; S ^ ; S : ; S ^ ; S ^ ; S 

♦ As tecnicas de suavizagao dizenri respeito 



essencialmente a redugao de ruido 

■ Media de imagehs (sferie de N imagehs da mesrha 



J ^„ 




>.^^^^^^^^ 



,y,,,^^^^^ 



1 



N 



8{^^y) = —^fi{^^y) 



Ntt 



Filtro de media 






♦ TqcIos OS pesos de um fjltro de 3x3 com valor 1/9. 



Filtro de mediana 






^y,,,,,^^^^ 



; '. 



; < 



♦ Substltulr cada p/xe/pe\a mediana da distribuigao dos 
nfveis de todos os p/xe/sda sua vizinhanga (induindo o 
proprio). Flltros de 3x3 ou 5x5 sao comuns, \ 



.;„„„H- 



Tecnicas de realce {^Enhancement) 

. ^. ^. ^. ^. ^. ^. ^, ^. ^. ^. ^. ^. ^. ^. ^.^. ^. ^. ^. ^. ^. ^. ^. t- -. ^. ^. ^. ^. ^. ^, ^. ^. ^. ^ -.^. ^.^. ^.^.^ ■ t- -. ^. ^r ---'--'-----'--'-- --- ---, -. ^. ^. ^. ^. ^. ^. t-- '--'---'--'--'--'--'- -^r ---'--'-----'--'-- --- --'.--- -■ -. ^. ^. ^. ^. t-- ---'--'--'-----'--'-- -^r -■ .^.^ ------ -I- -.^.^ -. ^. ^, ^. ^. ^. ^. ^. ^. ^. -> --- t- -. ^. ^. ^. ^. ^. ^r ^. ^. ^. ^. ^. ^. ^. ------ ------------ 



4r 



y,,,^^^^^ 




Para adaptagao ou compensagao face a 




^y, ,^TTTT^T 



Ty^TTTTTT^T 



Operacoes no histograma 



^ 



# Equal izagao 



i alteragao do valor de cada p/xe/pava uniformizar a distribuigao 
de nfveis de cinzento na imagem 




Histogramas locais em vez de global | 

t i i j ; i [ i i [ ; i j i i j -^y-^-^--- 

M Para afectar a imagem parcialmente sem levar em conta todo 



6 resto da imagem 



#[ Apiicagao de um histograma pre-definido 



r—'"-'^' 



Por exempio, para reaigai^ as partes mais escuras tornando-as 
mais Claras, e escurecendo as partes mais intensas 



; < 



A Expansao do contraste \ 

'[ i '■ '[ i '■ '[ i : 

t ; ( L ; ( L ; : 

■ Alteragao da imagem para varrer toda a gama dinamica de 



cinzentos com B bits: 



g 



M=F-i) 



" /(•y.y)-min[/(x,3;)] 
max[/(x, y)]- min[/(x, y)] 



Deteccao de arestas ( Edge detect! ori) 



4r 



'■ ^ ^ ^ ^ ^ ^ 

; S ^ ; S ^ ; S ^ ; S ; ; < ^ ; ( ^ ; S ^ ; S 

I mportante para a detecgad de objectos huma cena. 



A teen i ca pri nci pal e a de detecta r va ri ag6e§ de f 
intensidade usahdo urn oJDerador derivati\AD local 



; < 



Exempio de perfil de intensidades e suas derivadas: 













Operador de gradiente 



4r 




if,^ 



nigao 



G = 



G 
G 



3^ 



5x dy 



-iT 



Norma do gradiente e aproximagao usada 



G 





Variante discreta 



»-*■■ 



G,^f{x,y)-f{x-i,y) 




G^=f(x,y)-f{x,y-l) 



"] ""-^ 



k e filtros correspondentes 












-1 


1 















.;„„„H"" " i— ; 




Outros filtros de gradiente 



4r 



t ; ( I ; ( I ; 

Filtros de Sobel 



Alternativa mais eficiente para detectar arestas 

....; i > ; ': > ; i > ; ■: \..~. ; ': > ; ': > ; ': > , 



G.= 



-1 







1 



-2 







-1 







1 



G = 



y 



-1 



-2 



-1 















1 



1 



♦ 




aciano 



Muito sensivel ao rufdo. Pouco^^^^^^u para deteccao 

; < f ; ( 

de arestas. 



L[f{x.y)] = 






L= 







1 





1 



-A 



4 







1 







^y, ,^TTTT^T 



Exemplos do uso de filtros para arestas 



4- 



' • ^ ^ A. 


#\%* 


"..x^vvv 


F ^1 








Gradiente simples: Gx + Gy 




Filtro de Sobel com normalizagao 






Limitagao a meio da gama 



Gradiente simples: Gx + Gy 



Filtro de Sobel com normalizagao 



^y, ,^TTTT^T 



Li rciXjdCBiSXThresholdind) 



^ 




Processo de redugao dos nfveis de cinzento de 



Lima irfia^enn: 



Em geral para 2 niveis, ou seja, imagem binaria. 






^,.,,,..J. 



^ 



{^^y)= 



< 



v^ 



l^lf(x:3;)>r 
0^^/(x,>;)<r 

^ ' ! ^ ; ! ^ ' 




A limitagao e provavel mente a tecnica ma is 

I ■ \ I ■ \ I I \ I ■ \ I ■ \ I ■ \ I I \ I ■ \ 

^ ; : ^ : : ^ : : ^ : : ^ : : ^ : : ^ : : ^ : : 

utilizada em visao aplicada a robotica industrial 



/v/ 



e nao so. 




# E u ma ph rtiei ra 6 peragao pa ra "sepa ra r'' 6 



objecto do fundo 



Limitacao dinamica 



4r 



; ■: 

; i 

; < 

; i 



; i 



# Qual o thres/io/d que ma\s informacao preserva no! 

; ; ( I ; ( , ; i , ; ': '' i J < i > 

processo de limitagao? O valor central...? Nem sennpre! 



# Exempio de limitagao numa inriagem com 256 nfveis 




1 T=128 (pior) eT=80 (melhor) 



" >w 



1200 


- 


1 1 1 1 


1000 


- 


- 


800 


- 


- 


600 


- 


- 


400 


- 


- 


200 




1 II MM ll 





1 II 1 lll,lillJill,Lii , 


^^^^^^^^^^^^^^^^^^^^^^^^^m 




50 



100 



150 



200 



250 



T= 128 



A rnelhor solugad e obtida apos 



f Procu ra das reg I pes de s§pa ragao de^^2^^ 



y^TTTTTT^T 



SuaVizacao de imagens binarias 



4r 



# Situagoes de "suavizagao" em imagem binaria 



Pontes isolados ou "buracos" em imagens 
Cavidades/protuberancias ehn trogos rectos 
Vertices de Qi^j^^g (cantos) aus^ntes [ 



; '. 



; '. 



#^ y sp de pp^ragoe^ I pg k^ n^ ri as) cp os j?/xe/s. 



d 



9 



; < t ; < t ; < t ; < t ; < t ; < t ; < t i 1 

Vizinhanca de 3X3 onde os pixels sao designados assim: U 



- luz 

1 - escuro 



p'= p + b-g-{d + e)+d-e-{b + g) 






p' = p -[{a + b + d)-{e + g + h)+ 
+ {b + c + e)-{d + f + g)] 




P\d - P • [d • f • g)- {a + b + c + e + h)+ p 



Pbd^ 



V 



TE 



>• 



BE 



p-{a-b-d)-{c + e + f + g + h)+p 
p-{e-g-h)-{a + b + c + d + f)+p 
p-{b-c-e)-{a + d + f + g + h)+p 




Visao por Computador -- Harte iV 






Abbrdagerin a Medio Nfvel e 




la 




Visao por computador - O medio nfvel 

( ^ s i ! i i t i i ! ; i ! ! i t i i ! ; i 



4r 



-S * ,,,,,y,,,^^^^^ 



♦ Operadores hnorfologicos (binarios) 

■ Operadores para lidar com as partes da imagem divididas em 



^fobjectos" e 'Tundo" ^background) 

Um objecto e um conjunto de pixels o^e^ parti I ha uma mesma 
propriedade - comp o estarem ligados entre si (4- ou 6- 
conexao'yc\^\QBrs.6o estar Ngado a 4 ou a 8 vizinhos) j | 



♦I O elemento estruturante de um operador morfologico 



Vizinlnanga de efectividade do operador: 



♦ N 



4 



N 



8 



♦ Poderao ser definidos outros elennentos estruturantes, ex 



♦( A segmentagao 






f Separagao de objectos "de interesse" do fundo da imagem 



1 Algumas tecnicas (sequencias de operagoes morfologicas) 
para problennas de nQanipulagaode objectos em im^ 



Operadores Morfologicos -1 



4r 



-s *- 



; ■: 

; i 



# Erosao 



,y,^,^^^^^^ 



Torrar cada p/xe/de objecto 
(valor 1) que esteja N — ligado (N 
No,!...) a uvr\ p/xe/ die f undo (valor 



4' 



0) e colocar essejoo^ 

i i ; ■ ■ 

aOi 



♦ ,Em geral, reduz as dimensoes do 
objecto 






# 



Dilatagao I 

Tomar cada p/xe/de objecto 
(valor 1) e por todos os poc^/sde 
f undo (valor 0) que estao N- 
ligados (N4, Ng, A.) a esse p/xe/ 
como objecto (para o valor 1).; 



Erosao com N4 e Ng 



♦ Em geral, aumenta as dimensoes 



s 



do objecto 












Dilatagao com N . e N 



8 



Operadores Morfologicos - it 



4r 



-s *- 



# Fecho 



Operagao de dilatagad ^eguida de erosad^ 












♦ O resultado cbmum mais ihteressante e o de fundi h 



objectos que inicialmente so estariam ligados por um unico 



♦ "^jj— — >, Q qI^^^q p^Iq ^^^^j^^ ^^ ^^^^^^ 



#Abertura 



dperagao de erosao seg u i d^ de d i latagao 



♦ p resultado comum mais interessante e o de separar 
objectos que inicialmente so estariam ligados por poucos 
pixels, nomeadamente, linhas de um so p/xe/6e "largura 

♦ "Suaviza" o objecto pelo interior do seu contorno 



^y, ,^TTTT^T 



Ty^TTTTTT^T 



Operadores Morfologicos - itf 



4r 



-S * ,,,,,y,,,^^^^^ 



; ■: 

; i 

; i 



; i 

; < 

; i 



# Esqueletizagao 



J ^ 



>.^^^^^^^>; 



J ^ 



>.^^^^^^^j; 



J ^ 



^..^.^.^.^.^.^.^.j. 



ii Operagao de determinagao do esqueleto 



« Definigao de esqueleto: 

♦ Objecto filiforme (1 p/xe/de largura) .J 




....... 




.. que passa pelo "meio" do objecto 

... e que preserva a topologia do objecto original j 

! i j l \ E j * E ; * 

Uma variante {" th/nn/ngf') baseada na erosao 

I ; ( I ; ( I ; ( < ^ ; < ^ ; 

condicionada (menos exigente computacionalmente) 

« Urri p/xe/nao e erodido nas seguintes condigoes: 



; '. 



; '. 



♦ Se for isolado - condigao Q: 



♦ Se remove- 1 o afectar a conectividade - condigao Q i 



♦ Se rennove-lo afectar o comprimento da linha - Condigao C3 



Operadores Morfologicos - I V 



4r 




_j ,,,,,y,,,^^^^^^ 



Propagagao 



■j:^.^.^.^.^.^.^.J, 



J ^ 



>.^^^^^^^>; 



Qperacao de dilatacao 

; ( ^ i ( ^ ; ( ^ ! ( ^ ; ( J 3 ( J 

semente" (por exempio um esqueleto) ate aos 
limites dados por uma imagem "mascara", com 
base num dado elemento estruturante. 




Mascara 



Semente 



Em geral, o processo resulta 



numa mascara "cheia 



// 



Variantes de Esqueletizacao 
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♦ No 



_j ,,,,,y,,,^^^^^^ 



algoritmo de 



// 



thinning 



y,,,,,^^^^ 



' ha diversas 



combinagoes das condigoes C^ Q^ e C3 









So condigao C 

\ \ \ \ \ \ \ 

I ♦ Esqueleto reduzido a um 

So condigao d^ 



♦ .Esqueleto reduzido a linhas fechadas se houver objectos 
com buracos. Objectos sem buracos desaparecem. [ 



Ci + 




O esqueleto e constitufdo por yC^/Ve/s isolados para objectos 
|senn "bgracos" e ppr contornos fechados para objectos 
com "buracos". 



J,,,,,,,,*,, 



C + Q + Co 

I ♦ Ter^ se- a o esquel etp cpnripl etp trad i ci ona I 



Segrnentagao 
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; ( 



i > I > -. i > I i > '. ^ ^ 

♦ A limitagao { t/ires/io/of/ngf) dinamica 



; ■: 



Li mite baseado na media cl5 valor de todos os pixels 
da imagem -- metodo com limitagoes. 



; < 



Limitebaseado no histograma 



// 



♦ Algoritmo de "isodados 

♦ Algoritmo do "triangulo" 



Particularmente eficiente quando os objectos nao se 
demarcam claramente no histograma „„ 



Algoritmo de "simetria do fundo 



// 




Pico deiTiarcado e com simetria no inistograma 




Contomos dos objectos (atraves de filtros de 
gradiente) 
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: • : ; : ,• : ^ I :• : : ; 

Binarizacao- Algoritmo cle "isodados 



ff 



4r 



y,,,^^^^^^ 



J ^.^.^..^^. 



# Obtengao do limiarT de forma 



^y,,,,,^^^ 



iterativa^ 
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f Imagem a B bits com um histograms H(i) onde i=0,l;.. 



.,2^-1 



_OB-l 



Iteragao inicial: ponto central da gama dinamica Tq=2 



Calcular as medias dos yoZve/s separados em "objectos" (mO e 



"fundo" (rrf?) 



71-1-1 



Z '•?(') 



nir. = 



i=0 



71-1-1 



2^-1 



mi = 



j=71-i 



Z^(0 



/=o 



2^-1 



E MO 



/=r, 



it-i 



Nova iteragao: o novo valor do limiar e obtido como a media 
aritmetica dessas medias. 






T, 



^L+K-x 



O processo e repetido ate que o limiar deixe de variar. 



T, = r, 



k-\ 



Binarizacao - algoritmo do "triangulo" 
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Determinar no histograma o pohto de maior frequencia 
Determinar no histogranna o ponto de nnenor frequencia 



; '. 
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Definir unna linha unindo os dois pontos perfazendo um triangulo 



♦; O ponto do histogranna entre os pontos definidos que mais 



se 



afastar dessa linha ao Ipngo de uma perpendicular e p limiar., 
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de morfologia binaria 






^ I solar objectos com JDuracos 






# Preencher os buracos em objectos 















^ RemoN^r qbjec^QS nos bondds da imagefri 



^•^^^^^.^.^.^.j. 



^•^^^^^^^.^.j. 




Calculo do Exo-esqueleto 



^•^^^^^^^^j,^ 



^•^^^^^^^^j.^ 
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#Separar objectos que se tocam 



"] ;- 



# etc, 




Morfologicas - 



I solar objectos com buracos 



,y,,,^^^^^^ 
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i 1 Binarizar imagem e guardar para 



usar como mascara 



i Determinar o esqueleto nao 
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preservando os >a/>re/sterminais 



3. ■ Eliminar pontos isoiacfos do 




esqueleto 






4: 
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Propagar o restante esqueleto 



ate a nnascBra ob^^^^^ 




Morfologicas - 



Preencher buracos em obj 



H— "f- 



Binarizar 



Complementar a imagem (negar) 
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Definir o bordo (caixilho) da imagem 



como semente 





4. 



Propagar do bordo para os I i mites da 



imagem negada 



1 



1 nverter a imagem propagada 




Morfoloqi 



Remover objectos que tocam 



no J3Q|^Q (j^ jjy^3^^^ 

; ■: > i ■; > : ■: ^^. : 



T. 



Binarizar (obter mascara) 




Gerar um objecto semente com 



o bordo (caixilho) da imagem 



Propagar a semente ate a 

i i I i 

! E : < 

mascara 



; '. 



Fazer a operagao de ou- 



; '. 



exclusivp (XQR) com a innagem 
binarizada inicial (mascara) 



Operacoes Morfologicas - I V 



4r 



-S * ,,,,,y,,,^^^^^ 



< :, ■;,;<;(;<;< 

< :, ■;;;<;;(;;<;;< 

♦ \ Obtengao do Exo-esqueleto 



i„ 



Definigao de exo-esqueleto: 
esqueleto do "f undo" que contem 
OS objectos, "criando regioes" 

; \ \ I \ ; 

Binarizagap \ 

'■ \ \ \ \ 

Complemento da imagem 



^r'"""< 



y,,,,,^^^ 



( negagao) 

Calculo Bo esqueleto pela 
metodologia que ell mi na aslinhas 
terrininais (cbndigoes C^ e C2 na 
definigao da operagao de 
thinning 
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Fungao BWMORPH em MatLab (v5.3+) 
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BW2 
case 



^ 
^ 



^ 
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^ 
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= BWMORPH(BWl,OPERATION,N) applies the operation N times. N can be Inf, ip which 

the operation is repeated until the image no longer changes. 

OPERATION is a string that can have one of these values: 

'bothat' Subtract the input image from its closing . j 

'bridge' Bridge previously unconnected pixels 

'clean' Remove isolated pixels (I's surrounded by O's) 

'close' Perform binary closure (dilation followed by erosion) ....... 

'dlag' Diagonal fill to eliminate 8-connectivity of background 

'dilate' Perform dilation using the structuring element ones(3) 

'erode' Perform erosion using the structuring element ones(3) 

'fill' Fill isolated interior pixels (O's surrounded by I's) j 

'hbreak' Remove H-connected pixels 

'majority' Set a pixel to 1 if five or more pixels in its 3-by-3 neighborhood are I's 

'open' Perform binary opening (erosion followed by dilation) ^^^ ^ - 

'remove' Set a pixel to if its 4-connected neighbors are all I's, thus leaving only boundary pixels 

'shrink' With N = I nf, shrink objects to points; shrink objects with holes to connected rings \ 

'skel' With N = I nf, remove pixels on the boundaries of objects without allowing objects to break apart 

'spur' Remove end points of lines without removing small objects completely. i j L „„„ 

'thicken' With N = I nf, thicken objects by adding pixels to the exterior of objects without connected 
previously unconnected objects ; : : ; ; 

J ; S t ; S t ; S J ; S J ; < 

'thin' With N = I nf, remove pixels so that an object without holes shrinks to a minimally connected 
stroke, and an object with holes shrinks to a ring halfway between the holdand outer boundary 

'tophat' Subtract the opening from the input image 



